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I.  INTRODUCTION 

A.    OVERVIEW  OF  PATH  PLANNING 

Motion  planning  is  an  important  problem  in  robotics,  computational  geometry,  and  many  other  applica- 
tions. A  central  part  of  motion  planning,  known  as  path  or  route  planning,  is  the  process  of  determining  the 
path  to  be  taken  either  by  an  agent's  appendages  or  by  the  entire  agent.  The  research  reported  herein  is  con- 
cerned with  the  latter  of  these  two  path-planning  processes.  Specifically,  it  is  concerned  with  planning  paths 
over  long  distances  in  cross-country  terrain.  Thus  we  are  not  concerned  with  small-scale  motion,  where  robot 
appendages  are  moved  among  objects  on  a  work-bench  or  robot  legs  are  placed  on  the  ground,  for  example, 
nor  with  medium-scale  motion,  where  the  agent's  path  must  be  planned  so  as  to  provide  adequate  clearance 
for  itself,  but  with  large-scale  motion,  where  the  size  of  the  agent  is  negligible  compared  with  the  surround- 
ing terrain. 

Path  planning  will  not  typically  be  the  only,  or  even  the  most  important  task  which  competes  for  comput- 
ing resources.  For  example,  the  purpose  of  an  autonomous  vehicle  is  to  go  somewhere  independently  and  ac- 
complish a  mission,  a  task  which  will  require  a  large  number  of  intermediate  tasks  which  will  each  take 
computing  time  and  space.  Therefore  it  is  important  to  find  path-planning  algorithms  which  use  as  few  resour- 
ces as  possible.  This  means  increasing  run-time  speed  and  at  the  same  time  decreasing  storage  requirements. 
These  are  usually  conflicting  goals,  but  it  is  often  possible  to  increase  run-time  perfomiance  or  reduce  storage 
at  the  expense  of  preprocessing  time  in  a  pre-mission  phase  when  resources  are  not  in  demand. 

The  problem  of  finding  an  optimal  (least-cost) por/i  between  two  points  for  a  negligibly  small  agent  over 
fixed,  two-dimensional  terrain  with  known  cost  characterisfics  can  be  attacked  by  several  methods.  When  the 
agent  is  constrained  to  travelling  on  a  finite  number  of  known  paths,  the  problem  can  be  solved  by  network 
search  algorithms,  a  subject  of  thorough  study  in  operations  research.  When  the  agent  Ls  not  coastrained  to 
travelling  on  specified  paths,  the  area  is  called /ree  space.  Path  planning  in  two-dimensional  free  space  is 
beginning  to  be  studied  in  depth  by  researchers  in  such  fields  as  artificial  intelhgence,  robotics,  and  computa- 
tional geometry.  Most  methods  require  homogeneous-cost  background  terrain  interspersed  with  impassable 
obstacles,  as  for  example  for  the  Visibility-Graph  algoritluns  [Ref.  1].  However,  handling  additional  types  of 


terrain  features  (for  example,  linear  low-cost  features,  e.g.,  roads,  linear  fixed-crossing-cost  features,  e.g., 
rivers,  [Ref.  2]  and  polygonal  regions  of  homogeneous-cost  terrain,  e.g.,  forests,  swamps,  or  fields,  [Ref.  3]) 
will  improve  the  ability  to  model  terrain  realistically. 

A  promising  approach  to  two-dimensional  path-planning  in  fi^ee  space  which  we  develop  in  this  research, 
called  the  optimal-path-map  approach,  provides  greatly  improved  run-time  speed  at  the  expense  of  preprocess- 
ing time  and  storage.  This  approach  partitions  the  plane  during  preprocessing  into  regions  with  similarly-be- 
haved optimal  paths  and  then  locates  a  start  point  in  this  partition  at  run  time.  Rgure  1  shows  an  example 
optimal-path  map  with  boundaries  separating  the  regions  of  similarly-behaved  optimal  paths.  Additionally,  a 
set  of  vectors  is  superimposed  on  the  optimal-path  map  in  Figure  1  showing  initial  directions  of  selected  op- 
timal paths.  We  develop  the  theoretical  basis  for  such  a  partitioning  for  a  more  general  set  of  terrain  features 
than  has  previously  been  used  in  optimal-palh-map  construction,  making  this  approach  more  practical  for  real- 
world  cross-country  path  planning.  Tlien  once  the  optimal-path  map  is  constructed,  our  approach  can  appeal 
to  algorithms  with  worst-case  time  complexity  of  0(log  n)  to  locate  a  start  point  in  a  planar  partition  (see  Chap- 
ter II,  Section  B),  where  n  is  the  number  of  terrain-feature  vertices.  Once  the  start  point  is  located  in  tlie  par- 
tition, the  behavior  of  the  optimal  path  is  identified  and  the  path  can  be  reconstructed.  This  response  time  is 
very  attractive,  especially  for  real-time  systems  like  missiles  or  for  systems  with  many  competing  computing 
requirements  like  autonomous  vehicles. 

The  principal  results  of  our  research  are  threefold.  First,  we  adapted  the  wavefront  propagation  algorithm 
to  find  boundaries  between  regions  of  start  points  whose  optimal  paths  are  similarly  behaved,  and  implemented 
three  versions  of  the  new  algorithm.  Second,  we  characterized  boundaries  mathematically  by  means  of  analytic 
geometry.  Third,  we  proposed  an  algorithm  to  construct  the  planar  partition  using  these  mathematical  results 
for  convex  polygonal  and  piecewise-liiiear  terrain,  as  an  alternative  to  our  wavefront  propagation  algorithm. 

B.    ASSUMPTIONS 

We  assume  that  the  terrain  is  known,  and  can  be  modelled  by  combinations  of  the  five  primitive  types  of 
terrain  features  presented  below.  We  assume  that  terrain-feature  edges  can  be  modelled  piecewise-linearly, 
that  terrain  is  isotropic  (traversal  cost  is  independent  of  direction  of  travel),  and  that  no  two  polygonal  regions 
have  common  vertices.  Although  the  mobile  agent  is  constrained  to  travel  in  tlie  two-dimensional  plane  of  the 
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Figure  1 
Example  Optimal-Path  Map 
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ii^ut  map,  assigned  costs  of  travel  may  reflect  that  the  actual  surface  being  traversed  varies  in  height.  (See 
also  Chapter  II,  Sections  C  and  D.) 

Following  Mitchell  [Ref.  4],  we  make  die  assumption  called  the  general-position  assumption  (Appendix 
A,  Assumption  1-3),  that  no  terrain-feature  vertex  lies  on  a  homogeneous-behavior  boundary  generated  by 
another  terrain  feature,  i.e.,  that  there  is  not  an  accidental  alignment  of  boundaries  with  terrain-feature  ver- 
tices. This  restriction  does  not  change  the  following  results  significantly,  but  allows  the  discussion  to  proceed 
without  convoluted,  but  unimportant,  conventions.  In  an  actual  implementation  of  the  algorithms  proposed 
below,  this  assumption  must  be  retracted. 

The  following  five  terrain-feature  types  are  allowed: 

•  Background.  Areas  of  the  map  which  do  not  contain  other  terrain  features  have  a  fixed  cost 
per  distance  travelled. 

•  Obstacles.  An  obstacle  is  a  convex  polygon  enclosing  impassable  terrain. 

•  Rivers.  A  river  segment  is  a  line  segment  whose  cost  to  the  agent  to  cross  anywhere  along  its 
length  is  a  fixed  constant,  not  dependent  on  the  angle  of  crossing. 

•  Roads.  A  road  segment  is  a  line  segment  with  a  fiixed  cost  per  distance  for  length- wise  traver- 
sal. Thus  a  road  segment  is  infinitesimally  thin,  can  be  crossed  at  no  cost  to  the  agent,  and  can 
be  entered  or  left  anywhere  along  its  length. 

•  Convex  Homogeneous-Cost  Areas.  A  convex  homogeneous-cost  area  {HCA)  is  a  convex 
polygon  with  a  constant  positive  cost  per  distance  travelled.  An  HCA  may  have  cost  per  dis- 
tance greater  or  less  llian  the  background  terrain,  but  not  zero.  The  agent  may  enter  or  leave  the 
area  at  any  point  on  its  circumference  at  no  additional  cost. 

These  terrain-feature  types  could  all  be  modelled  by  HCAs.  However,  allowing  obstacle,  river,  and  road 
terrain  features  enhances  efficiency  by  allowing  us  to  take  advantage  of  their  simpUcity.  Specifically,  it  is  an 
advantage  to  avoid,  where  possible,  the  compUcated  analysis  of  paths  through  homogeneous-cost  regions  (see 
Chapter  II,  Section  E2b(3)). 

How  realistic  are  the  above  assumptions?  There  arc  at  least  three  issues.  First,  is  it  reasonable  to  expect 
that  we  know  the  characteristics  of  the  terrain;  second,  can  terrain  be  adequately  modelled  by  piecewise  linear 
curves;  and  third,  will  the  use  of  convex  non-adjacent  polygons  be  sufficient?  As  discussed  in  Chapter  II,  Sec- 
tion D4,  the  Defense  Mapping  Agency  and  other  U.S.  Government  agencies  currently  have  the  ability  to 
produce  maps  which  characterize  terrain  according  to  the  speed  at  which  a  given  vehicle  type  can  traverse  it. 
(Of  course,  cost  in  terms  of  time  is  the  reciprocal  of  speed.)  Tlie  program  used  to  produce  these  maps,  called 


Army  Mobility  Model  (AMM),  takes  as  input  a  digitized  combination  of  soil  conditions,  vegetation,  man-made 
features,  and  elevation  which  is  available  at  present  only  for  selected  areas  of  the  earth,  but  there  is  an  ongo- 
ing effort  to  expand  this  database.  As  this  database  is  expanded,  AMM  will  be  able  to  produce  cost  maps  of 
more  of  the  world's  surface,  so  that  a  path-planning  system  which  uses  AMM  cost  maps  as  input  can  be  ex- 
pected to  know  the  characteristics  of  the  terrain.  However,  an  additional  consideration  is  that  terrain  may  be 
impermanent.  In  this  case  our  assumptions  will  be  invalidated. 

The  second  issue  is  whether  terrain  can  be  adequately  modelled  using  only  piecewise  linear  curves.  Com- 
putational geometry  rehes  very  heavily  on  the  use  of  piecewise  linear  curves  to  approximate  reality,  since  there 
is  a  fixed  precision  associated  with  any  computer,  and  a  finite  amount  of  storage.  In  fact,  the  very  concept  of 
continuity  is  a  mathematical  abstraction,  since  at  some  level  the  most  smoothly  continuous  curves  will  be  seen 
to  degenerate  into  discrete  elements.  For  example,  a  wood-line  may  seem  to  form  a  continuous  curve,  when 
in  fact  at  the  scale  of  individual  trees  it  is  clearly  discontinuous.  Since  the  database  maintained  by  the  Defense 
Mapping  Agency  has  a  maximum  resolution  of  12.5  meters  square,  we  can  be  assured  that  no  representation 
we  propose  will  be  more  accurate  than  this.  One  additional  consideration  is  that  small  nuances  of  the  terrain 
wiU  normally  have  much  less  effect  on  optimal  paths  than  wiU  large  features.  Of  course,  it  is  always  desirable 
fi-om  the  viewpoint  of  efficiency  to  use  as  few  line  segments  as  possible  to  approximate  a  curve  in  order  to 
reduce  the  number  of  terrain-feature  vertices  in  the  input  map. 

The  third  question  is  much  more  of  a  problem.  The  use  of  convex  polygons  will  clearly  not  approximate 
all  types  of  terrain  if  we  require  that  no  two  polygons  have  common  vertices.  The  output  of  Anny  Mobility 
Model  for  example,  allows  non-convex  polygons.  This  research  uses  the  non-adjacent-convex-polygon  as- 
sumption in  order  to  attack  a  problem  of  somewhat  smaller  scope  first,  with  the  intention  of  expanding  the 
scope  in  the  future  to  incorporate  non-convex  regions.  The  next  step  will  be  to  extend  the  analysis  of  Chapter 
V  to  include  the  case  of  adjacent  convex  polygons. 

C.    THE  OPTIMAL-PATH-MAP  APPROACH  TO  PATH-PLANNING 

The  opiimal-palh-niap  approach  to  path  planning  groups  paths  according  to  their  general  behavior  with 
respect  to  a  goal  point.  A  surjective  function  is  defined  to  map  optimal  paths  to  generalizing  path  descriptions 
so  that  paths  with  similar  behavior  are  mapped  to  the  same  description.  Tlie  usual  definition  of  "similar  be- 


havior"  is  crossing  the  same  sequence  of  terrain-feature  vertices  and  edges.  Boundaries  are  constructed  to  par- 
tition the  plane  of  the  map  into  regions  whose  start  points  have  similar  behavior.  Then  to  determine  an  optimal 
path,  a  given  start  point  is  located  within  the  partition.  The  path  description  of  the  region  associated  with  the 
start  point  applies  to  the  optimal  path  from  the  start  point,  so  this  path  description  is  specialized  for  the  given 
start  point  to  give  an  optimal  path.  The  focus  of  our  research  is  the  construction  of  the  planar  partition. 

How  can  paths  be  represented  so  they  can  be  grouped  according  to  their  behavior?  Theorem  1-2  states  that 
optimal  paths  among  piecewise-linear  and  polygonal  terrain  are  always  piecewise  linear,  changing  direction 
only  at  terrain-feature  vertices  and  edges.  This  fact  suggests  two  possible  ways  to  represent  optimal  paths.  The 
more  natural  way  to  represent  a  single  piecewise-linear  path  would  be  by  listing  the  coordinates  of  its  turn 
points.  Alternately,  we  could  list  the  terrain- feature  vertices  and  edges  at  which  a  path  turns.  The  first  repre- 
sentation has  the  difficulty  that  there  is  no  immediate  way  to  tell  from  the  list  whether  or  not  turn  points  from 
two  different  paths  lie  on  the  same  terrain-feature  edge.  The  second  representation  allows  paths  to  be  grouped 
more  easily  according  to  whether  they  cross  the  same  terrain-feature  edges  and  vertices,  but  has  the  difficul- 
ty that  it  is  not  clear  by  looking  at  the  hst  what  the  coordinates  of  a  turn  point  are  on  a  terrain-feature  edge. 
This  conflict  suggests  a  composite  representation  wherein  a  list  contains  terrain-feature  vertices  and  edges, 
and  for  each  edge,  may  also  contains  as  supplemental  information  the  exact  coordinates  at  which  the  path  cros- 
ses the  edge.  This  is  the  representation  we  adopt,  calling  such  a  list  a  path  list. 

The  path  list  can  be  used  to  represent  a  specific  optimal  path  as  well  as  a  generalized  description  of  an 
optimal  path.  If  a  path  list  has  a  terrain-feature  vertex  as  its  first  element,  the  path  is  completely  determined 
because  it  will  go  from  the  start  point  directly  to  the  vertex,  from  where  a  unique  path  goes  to  the  goal  (Corol- 
lary 1-3.1,  Appendix  A).  If  a  path  list  has  an  edge  as  its  first  element  and  no  supplemental  information  is  in- 
cluded with  that  edge,  the  path  Ust  represents  all  optimal  paths  whose  first  turn  point  lies  on  that  edge.  If 
however,  coordinates  of  the  crossing  point  are  included  with  the  edge,  the  path  is  completely  determined.  When 
listing  an  edge  in  a  path  list,  it  is  also  important  to  distinguish  between  edges  crossed  from  different  directions, 
because  for  example,  paths  may  enter  the  same  portion  of  a  road  from  both  sides;  we  want  to  distinguish  be- 
tween the  two  sets  of  paths  which  come  from  either  side  of  the  road.  For  consistency  in  our  discussions,  we 
adopt  the  convention  that  for  a  start  point  with  no  feasible  paths  (for  example,  a  start  point  inside  an  impass- 
able obstacle),  the  optimal-path  hst  is  a  null  symbol  concatenated  with  the  goal  point. 


Now  the  path-generalizing  function  can  be  defined  more  fully  for  the  usual  definition  of  similar  behavior 
of  paths.  For  the  set  O  of  all  optimal  paths  and  the  set  (VL^E)*  of  all  combinations  of  terrain-feature  vertices 
and  edges,  the  fiinction  f :  O  — ^(VWE)*  maps  an  optimal  path  to  its  path  list. 

Define  a  homogeneous-behavior  region  with  respect  to  a  goal  G  as  the  set  of  all  start  points  whose  op- 
timal paths  are  mapped  by  the  path-generalizing  fiinction  to  the  same  set.  Thus,  start  points  whose  optimal 
paths  have  the  same  path  lists  are  considered  to  be  in  the  same  homogeneous-behavior  region  for  the  usual 
definition  of  the  path- generalizing  function.  Define  the  root  of  a  homogeneous-behavior  region  as  the  first  ele- 
ment of  the  path  Ust  associated  with  the  region.  Since  a  root  may  represent  a  terrain-feature  edge  which  can 
be  crossed  at  any  point  along  its  length,  the  supplemental  information  cannot  be  retained  by  the  path  list  as- 
sociated with  the  root.  Define  a  homogeneous-be/iavior  boundary  as  the  locus  of  points  lying  in  two 
homogeneous-behavior  regions.  On  a  homogeneous-behavior  boundary  (except  for  obstacle  edges),  at  least 
two  optimal  paths  exist  for  a  given  point. 

The  fundamental  principle  upon  which  spatial  reasoning  about  optimal  paths  is  based  is  the  principle  of 
optimaUty.  In  its  general  sense,  the  principle  of  optimality  states  that  if  it  applies  to  a  system,  future  optimal 
policy  in  the  system  depends  only  on  its  current  state  and  not  on  its  past  history.  Theorem  I-l  (Appendix  A) 
states  that  the  principle  of  optimahty  applies  to  the  path-planning  domain.  In  other  words,  it  states  that  the 
portion  of  an  optimal  path  from  any  point  on  the  path  to  the  goal  is  also  an  (^timal  path. 

We  extend  the  general-position  assumption  discussed  above  to  terrain  feature  edges  by  adopting  the  con- 
vention that  any  terrain  feature  edge  intersected  by  a  homogeneous-behavior  boundary  is  to  be  treated  as  two 
distinct  edges,  one  on  each  side  of  the  boundary.  The  immediate  result  of  this  assumption,  the  principle  of  op- 
timality, and  Theorem  1-2,  is  the  uniqueness  of  optimal  paths  from  any  terrain  feature  vertex  or  across  the  in- 
terior of  any  edge.  (Corollary  1-3.1,  Appendix  A.)  It  follows  from  the  definitions  of  homogeneous-behavior 
regions,  roots,  and  boundaries,  the  general-position  assumption,  and  Theorem  1-2  that  there  is  a  unique  root 
associated  with  each  homogeneous-behavior  region  (Corollary  1-3.2).  It  also  follows  that  homogeneous-be- 
havior regions  are  "star-shaped"  with  respect  to  the  region  root  (Corollary  1-3.3). 

An  optimal-path  tree  of  a  set  of  terrain  features  with  respect  to  a  goal  point  is  the  index  tree  for  all  pos- 
sible path  lists.  In  other  words,  it  is  the  tree  whose  root  represents  the  goal  and  who.se  internal  nodes  are  ter- 
rain-feature vertices  and  edges,  such  that  for  each  node,  the  optimal  paths  from  that  node's  vertex  or  edge  go 


first  to  the  vertex  or  edge  represented  by  the  node's  parent.  Therefore,  the  path  list  for  the  vertex  or  edge  as- 
sociated with  a  node  is  found  by  following  the  parent  pointer  of  the  node  back  to  the  root  of  the  tree,  which  is 
the  goal.  Each  node  of  the  tree  corresponds  to  a  unique  homogeneous-behavior-region  root,  which  corresponds 
to  a  unique  homogeneous-behavior  region.  Thus,  locating  a  start  point  in  a  region  of  the  planar  partition  is 
equivalent  to  specifying  which  node  of  the  tree  identifies  the  behavior  of  the  optimal  path  from  that  start  point. 
Figure  2  shows  an  example  planar  partition  with  its  corresponding  optimal-path  tree. 

An  initial  version  of  the  optimal-path  tree  can  be  constructed  by  using  a  point-to-point  path  planner  to 
compute  the  optimal  path  from  each  terrain-feature  vertex  on  the  input  map  and  then  inserting  the  turn  points 
of  each  resulting  optimal  path  into  a  tree.  The  method  presented  in  Chapters  V  and  VI  uses  the  optimal-path 
tree  to  construct  the  planar  partition,  and  revises  it  by  inserting  nodes  which  correspond  to  terrain-feature  edges. 
However,  the  method  presented  in  Chapter  III  constructs  the  optimal-path  tree  at  the  same  time  as  it  constructs 
the  planar  partition. 

An  optimal  path  map  or  0PM  is  a  partition  of  the  flane  into  homogeneous-behavior  regions  with  respect 
to  a  goal,  along  with  its  associated  optimal-path  tree.  There  is  a  finite  optimal-path  tree  associated  with  every 
two-dimensional  map  consisting  of  terrain  as  defined  above  (Theorem  1-4,  Appendix  A).  The  specification  of 
this  optimal-path  tree  is  a  necessary  part  of  the  optimal-path  map,  and  we  will  assume  that  the  term  optimal- 
path  map  implies  both  the  representation  of  tlie  planar  partition  and  of  the  optimal-path  tree,  with  some  means 
of  linking  each  node  with  its  corresponding  homogeneous-behavior  region  in  the  partition.  A  typical  repre- 
sentation of  the  planar  partition  is  the  doubly-connected-edge-list  discussed  in  Chapter  II,  Section  B. 

Several  partitioning  algorithms  for  terrain  containing  only  obstacles  (the  binary  case)  have  been  proposed 
in  an  attempt  to  present  faster  solutions  to  the  point-to-point  path-planning  problem  (see  Chapter  2),  and  several 
algorithms  even  solve  a  portion  of  the  optimal-path-map  problem  with  respect  to  weighted  regions  by  creat- 
ing tlie  optimal-path  tree  in  pursuit  of  single-path  solutions.  In  this  research,  we  investigate  the  problem  of 
creating  an  optimal-path  map  for  weighted-region  terrain,  focusing  on  a  solution  to  the  optimal-path-map 
problem  as  an  end  in  itself.  We  choose  to  investigate  this  approach  because  it  offers  the  most  opportunity  for 
enhancement  of  run-time  performance  at  the  expense  of  preprocessing  time  because  of  the  promise  of  0(log 
n)  run-lime  complexity  to  identify  an  optimal  path  for  a  map  of  n  terrain-feature  vertices. 
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Figure  2 
PlajKu  Piutition  with  Corresponding  Optinial-Palh  Tree 


D.    SUMMARY  OF  RESEARCH  REPORTED  HEREIN 

In  Chiller  II,  we  explain  and  classify  the  path-planning  algorithms  relevant  to  this  research,  specifically 
those  dealing  with  negligible-sized  agents  in  a  fixed,  known  environment  where  terrain  is  two-dimensional, 
fi«e  space. 

One  method  of  obtaining  sub-optimal  solutions  to  the  optimal-path-msq}  problem  uses  a  version  of  the 
standard  wavefront  propagation  algorithm.  Such  an  algorithm  is  presented  in  Chapter  III,  and  the  extensions 
necessary  to  create  q>timal-path  maps  are  developed.  Chapter  IV  is  an  analysis  of  the  algorithm  in  the  pre- 
vious chapter.  Two  primary  sources  of  error  are  examined,  and  known  results  of  inherent  inaccuracy  in 
wavefront  propagation  are  extended  to  the  resulting  OPMs.  The  theoretical  time  and  space  complexity  of  the 
above  algorithm  is  presented,  along  with  empirical  results  concerning  execution  times  for  three  alternative 
heuristics  used  with  the  algorithm. 

A  second  approach  to  solving  the  two-dimensional  optimal-path-map  problem  is  to  reason  about  how  op- 
timal paths  behave  in  the  presence  of  various  terrain  features.  This  reasoning  leads  to  analytical  characteriza- 
tion of  the  boundaries  between  homogeneous-behavior  regions  of  similarly-behaved  optimal  paths  as  functions 
of  terrain  feature  characteristics.  It  turns  out  that  all  boundaries  generated  by  the  roads,  rivers,  and  obstacles 
are  segments  of  conic  sections.  Other  boundaries  are  more  mathematically  complex,  and  in  many  cases  can- 
not be  described  in  closed-form  expressions.  First  in  Chapter  V,  a  set  of  definitions  is  presented,  followed  by 
development  of  the  characterizations  of  boundaries  generated  by  "primitive"  terrain  feature  types,  i.e.,  single 
polygons  and  single  line-segments.  Then  the  characterization  of  more  ccwnplex  combinations  of  primitive  ter- 
rain features  is  discussed,  and  decomposability  is  defined  for  construction  of  optimal-path  maps. 

In  Chapter  VI,  algorithms  use  the  results  of  Chapter  V  to  generate  OPMs  more  accurate  than  those  of 
Chapter  III  for  isolated  occurrences  of  each  type  of  primitive  terrain  feature.  Then  an  algorithm  based  on  the 
divide-and-conquer  paradigm  is  presented  to  generate  OPMs  for  some  "decomposable"  maps  with  multiple 
terrain  features.  In  Chapter  VII  the  divide-and-conquer  exact-OPM  algorithm  is  analyzed,  first  in  terms  of 
sources  of  error,  and  then  with  respect  to  theoretical  time  and  space  complexity.  Then  the  empirical  perfor- 
mance of  an  implementation  is  discussed.  Chapter  VIII  summarizes  the  results  of  the  research. 
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n.  RELEVANT  RESEARCH 

A.    APPLICABLE  CONCEPTS  FROM  ARTIFICLAL  INTELLIGENCE 
1.     Search  Methods 

One  of  the  central  problem-solving  techniques  in  Artificial  Intelligence  is  the  use  of  search  [Ref.  5], 
[Ref.  6].  A  search  problem  is  couched  in  terms  of  a  current  state  and  a  goal  state,  operators  are  defiried  which 
transform  the  system  fi-om  one  state  to  another,  and  a  search  is  conducted  for  a  sequence  of  operators  which 
will  transform  the  current  state  to  a  goal  state.  Conceptually,  a  search  space  is  a  directed  graph  whose  nodes 
represent  all  possible  states,  and  whose  edges  represent  operators.  Solving  the  problem  means  applying  graph- 
search  algorithms  in  the  search  space  to  find  a  path  from  a  start  node  to  a  goal  node.  The  search  space  may  be 
a  very  large,  even  an  infinite  graph  which  is  not  represented  explicitly,  but  as  the  algorithm  proceeds,  it  creates 
a  sub-graph,  called  a  search  graph  (or  search  tree),  whose  nodes  are  the  states  actually  reached  during  the 
search.  The  underlying  aim  is  to  find  ways  to  make  the  search  graph  as  small  as  possible  while  still  including 
the  goal  state,  i.e.,  to  look  at  as  few  states  of  the  search  space  as  possible  on  the  way  to  finding  the  goal.  There 
are  two  ways  of  limiting  the  size  of  the  search  graph.  One  way  is  to  guide  the  search  by  means  of  heuristics, 
and  the  other  is  to  represent  the  problem  in  such  a  way  as  to  reduce  the  search  space. 

When  no  domain-specific  information  is  used  to  guide  decisions  about  which  node  of  the  search  graph 
to  process  next,  the  process  is  called  blind  search.  Although  few  problems  have  a  search  space  small  enough 
to  allow  practical  use  of  blind  search,  the  techniques  used  provide  the  foundation  for  heuristic  search,  where 
information  is  used  to  guide  the  search.  All  the  search  techniques  discussed  below  can  be  said  to  conform  to 
a  general  model  where  the  search  is  initiaUzed  by  placing  an  initial  node  on  an  agenda,  and  proceeds  by  ex- 
panding the  first  node  on  the  agenda,  putting  the  node's  children  on  the  agenda  in  a  manner  which  varies  from 
technique  to  teclmique. 

Branch-aiui-bound  search,  also  known  as  Dijkstra's  algorithm,  is  a  generalization  of  breadth-first 
search  which  uses  heuristic  information.  The  distance  of  a  node  from  the  start  is  not  measured  by  the  number 
of  edges  from  the  node  to  the  root  as  in  breadth-first  search,  but  by  the  total  cost  of  the  edges.  Thus,  each  edge 
has  an  associated  cost,  and  at  each  iteration,  after  a  node  has  been  expanded  and  its  children  placed  in  the  agen- 
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da,  the  agenda  is  sorted  by  cost  to  keep  lower-cost  nodes  first.  Since  physical  distance  is  the  normal  metric  in 
the  path-planning  domain,  this  is  a  natural  search  technique  to  use.  This  technique  guarantees  that  the  first  path 
found  to  the  goal  is  the  lowest-cost  solution. 

Another  search  strategy  which  is  widely  used  in  path  planning  is  called  A*  search.  It  sorts  its  agen- 
da according  to  the  sum  of  the  cost  function  and  evaluation  function  at  each  node.  If  the  evaluation  function 
value  fi^om  any  point  to  the  goal  is  a  lower  bound  on  the  actual  cost  from  the  point  to  the  goal,  it  is  guaranteed 
that  the  first  time  the  optimal  path  to  the  goal  is  selected  from  the  agenda  it  will  be  recognized  as  optimal. 

2.  Domain-Specific  Heuristics  as  Guides  to  Search 

General  solutions  to  problems  tackled  by  Artificial  InteUigence  researchers  are  usually  so  difficult 
that  great  advantages  are  to  be  gained  by  finding  rules-of-thumb  to  focus  the  search  in  the  right  direction. 
Heuristic  search  strategies  use  cost  and/or  evaluation  functions  to  guide  the  search.  Rich  [Ref.  7]  states  that 
the  field  of  artificial  intelhgence  is  largely  the  study  of  heuristic  search  for  solving  difficult  problems,  and  The 
Handbook  of  Artificial  Intelligence  calls  heuristic  search  "one  of  the  key  contributions  of  Artificial  Intelligence 
to  efficient  problem -solving"  [Ref.  5].  In  the  path-planning  domain,  there  is  a  natural  heuristic  which  is  often 
used  to  guide  search  for  an  optimal-cost  path,  which  is  that  for  a  path  from  the  start  point  to  an  intermediate 
point,  if  the  intermediate  point  is  closer  in  straight-line  distance  to  the  goal  than  some  other  intermediate  point 
from  another  path  (irrespective  of  terrain  yet  to  be  negotiated),the  first  path  is  preferred  over  the  second  for 
further  exploration. 

3.  Problem  Representation 

It  is  often  the  case  in  problems  studied  in  artificial  intelligence  research  that  a  problem  which  seems 
very  difficult  when  represented  in  one  way  will  suggest  a  natural  solution  when  represented  in  a  different  way. 
In  other  words,  finding  a  good  problem  representation  is  often  the  key  to  efficient  solution  of  the  problem,  as 
well  as  to  clear  understanding  of  the  problem  on  the  part  of  researchers  [Ref.  5].  Path-planning  algorithms,  for 
example,  are  essentially  ways  of  transforming  an  infinite  search  space  to  a  finite  one,  and  then  searching  the 
transformed  search  space  using  one  of  several  heuristic-aided  search  algorithms  discussed  above. 
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B.    APPLICABLE  CONCEPTS  FROM  COMPUTATIONAL  GEOMETRY 
1.     Definitions  for  Optimal-Path  Maps 

a.  Path  List 

When  optimal  paths  are  guaranteed  to  consist  of  Une  segments  between  a  finite  number  of  turn 
points,  which  Theorem  1-2  shows  is  true  of  the  terrain  considered  in  this  research,  they  can  be  represented  by 
listing  these  turn  points.  It  is  also  shown  in  Theorem  1-2  that  these  turn  points  occur  only  at  terrain- feature  ver- 
tices and  edges.  This  suggests  two  possible  ways  to  list  the  turn  points.  The  most  direct  way  is  to  list  the  coor- 
dinates of  the  points.  This  allows  direct  reconstruction  of  the  path  from  its  list.  However,  this  representation 
makes  it  somewhat  more  difficult  to  compare  two  lists  to  determine  if  the  paths  they  represent  cross  the  same 
edges.  It  might  be  better  to  list  expUcitly  the  vertices  and  edges  that  a  path  crosses.  This  representation  has  the 
drawback,  however,  that  some  computation  would  be  necessary  to  determine  for  each  edge  crossing  exactly 
where  the  crossing  occurred.  Since  our  research  is  primarily  concerned  with  grouping  paths  together  accord- 
ing to  their  general  behavior,  we  adopt  the  second  representation,  calling  such  a  Ust  a  path  list.  An  example 
path  list  from  start  point  S  to  goal  point  G  in  Figure  3  is  [E,A,G],  while  from  point  R  there  are  three  possible 
good  path  lists  of  [F,C,G],  [H,G],  and  [PQ,G].  For  consistency  in  later  discussions,  we  say  that  for  a  start  point 
with  no  feasible  paths  (for  example  a  start  point  in  the  center  of  an  impassable  obstacle),  the  path  list  consists 
of  a  special  null  symbol  concatenated  with  the  goal  point. 

b.  Path-Generalizing  Function 

The  concept  upon  which  the  optimal -path-map  approach  to  path  planning  is  based  is  that  paths 
can  be  grouped  according  to  their  behavior.  A  path-generalizing  function  f:0— >B  is  defined  from  the  set  of 
optimal  paths  to  the  set  of  behaviors  of  optimal  paths,  which  maps  an  optimal  path  to  a  description  of  its  be- 
havior. Since  many  paths  may  share  the  same  behavior  descriptions,  f  is  a  surjective  function.  The  usual  way 
to  define  the  behavior  of  a  path  is  by  listing  the  vertices  and  edges  it  crosses.  In  that  case  B  =  (VWE) * ,  the 
set  of  all  combinations  of  terrain-feature  vertices  and  edges.  Since  path  lists  are  defined  in  terms  of  vertices 
and  edges,  tlie  usual  definition  of  f  is  that  it  maps  an  optimal  patli  to  its  path  list. 

A  path-generahzing  relation  R  which  relates  two  points  if  the  path-generahzing  function  maps 
their  optimal  paths  to  identical  path  lists  is  an  equivalence  relation  because  the  identitj'  relation  is  in  general 
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an  equivalence  relation.  Since  the  domain  of  f  is  the  set  of  all  points  on  the  input  map,  f  induces  a  partition  on 
the  plane  of  the  input  map  through  this  equivalence  relation. 

c.  Homogeneous-Behavior  Region 

Define  a  liomogeneous-beluivior  region  with  respect  to  a  goal  point  and  a  path- generalizing  func- 
tion as  the  set  of  start  points  whose  optimal  paths  to  that  goal  point  are  mjqjped  by  the  path-generalizing  func- 
tion to  the  same  path  behavior.  In  our  work,  this  is  equivalent  to  saying  that  it  is  the  set  of  start  points  whose 
optimal  paths  have  the  same  path  lists.  Each  homogeneous-behavior  region  corresponds  to  an  equivalence 
class  of  the  path-generalizing  relation  R,  and  so  is  a  subdivision  of  the  partition  induced  by  R  on  the  plane  of 
the  input  map.  In  Figure  3,  for  example,  point  S  is  in  the  homogeneous-behavior  region  enclosed  by  segments 
EI,  DC,  KL,  and  LE. 

An  optimal-path  map  (0PM)  is  defined  as  the  partition  of  the  plane  of  the  input  map  into 
homogeneous-behavior  regions,  along  with  their  associated  path  lists.  For  the  conceptual  representation  of  an 
optimal-path  map  shown  in  the  top  half  of  Figure  3,  the  two  data  structures  in  the  bottom  half  of  the  figure 
fully  specify  the  0PM. 

d.  Homogeneous-Behavior-Region  Root 

Because  of  the  definition  of  homogeneous-behavior  regions,  each  unique  path  fist  defines  a 
homogeneous-behavior  region.  Thus  given  a  path  list,  the  associated  region  is  defined.  By  the  general-posi- 
tion assumption  (Assumption  1-3,  Appendix  A),  there  will  be  no  accidental  alignment  of  boundaries  from 
another  region  such  that  there  is  more  than  one  path  list  from  a  region.  The  first  element  of  the  path  list  as- 
sociated with  a  region  is  defined  as  the  homogeneous-beliavior-region  root.  For  example,  in  Figure  3  the  path 
list  of  start  point  S  with  respect  to  goal  point  G  is  [E,A,G],  and  point  E  is  the  region  root  of  the  region  of  which 
S  is  a  member. 

2.     Data  Structures 

Several  data  structures  with  wide  utility  in  computational  geometry  are  useful  in  the  optimal-path- 
map  domain.  Since  an  optimal-path  map  consists  of  the  set  of  path  lists  from  homogeneous-behavior-region 
roots  and  a  planar  partition,  these  two  items  must  be  represented. 
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a.  The  Optimal-Path  Tree 

The  optimal-path  tree  is  a  way  of  representing  a  set  of  path  lists.  It  is  a  direct  extension  of  the 
shortest-path  tree  concept  [Ref.  8].  An  optimal-path  tree  (OPT)  is  a  tree  whose  root  (not  the  same  as  a 
homogeneous-behavior-region  root)  is  the  specified  goal  point,  whose  nodes  are  terrain-feature  vertices  and 
edges,  and  for  which  an  optimal  path  from  tlie  terrain-feature  vertex  or  edge  represented  by  any  node  in  the 
tree  goes  directly  to  the  vertex  or  edge  represented  by  that  node's  parent.  Each  node  of  the  tree  corresponds 
to  a  homogeneous-behavior  region,  and  every  homogeneous-behavior  region  is  represented  by  a  node,  (see 
Theorem  1-4,  Appendix  A).  Thus  by  labeling  regions  and  OPT  nodes  the  same,  or  by  estabUshing  pointers 
from  regions  to  nodes  of  the  OPT,  a  linkage  is  established  which  allows  retrieval  of  the  appropriate  OPT  node 
given  a  region.  Then  the  path  list  associated  with  the  region  can  be  reconstructed  by  tracing  upwards  through 
the  tree  to  the  tree's  root.  Note,  however,  that  further  computation  usually  is  necessary  to  reconstruct  the  op- 
timal path  fi^om  the  path  list  by  finding  optimal  edge  crossings.  Another  important  characteristic  of  the  op- 
timal-path tree  is  that  it  reduces  the  redundancy  of  storage  of  optimal  paths  associated  with  terrain-feature 
vertices  and  edges  by  integrating  them  all  into  one  structure.  In  Figure  3,  the  optimal-path  tree  is  shown  for 
the  given  terrain  map. 

b.  The  Doubly-Connected  Edge  Ust  (DCEL) 

A  planar  partition  could  be  represented  in  edge-list  form  in  which,  for  each  vertex  of  a  piecewise- 
linear  approximation  of  the  boundary  between  subdivisions  of  the  partition  an  ordered  list  of  its  incident  edges 
is  given.  Although  this  is  a  natural  representation,  some  of  the  information  implicitly  present  could  be  explicit- 
ly listed,  enhancing  efficiency  at  the  expense  of  preprocessing  time  and  storage.  A  doubly-connected  edge  list 
is  such  a  data  structure  that  has  proven  to  be  quite  useful  in  representing  a  planar  partition.  Represent  each 
edge  as  a  node  in  the  DCEL,  and  label  each  edge,  vertex,  and  region.  Note  that  the  terms  edge  and  vertex  as 
used  in  connection  with  the  DCEL  refer  to  piecewise-finear  homogeneous-behavior-region  bouixlary  edges 
and  vertices,  not  to  terrain-feature  edges  and  vertices.  With  each  edge-node,  associate  a  six-tuple  of  data  ele- 
ments (Vi,V2vRi,R2,Pi,P2).  The  Vi  are  the  two  vertices  of  the  edge.  The  assignment  of  vertices  to  the  two 
fields  V|  and  V2  is  arbitrary,  but  once  assigned  is  fixed.  Once  the  vertices  are  assigned,  the  edge  becomes 
directed  from  V|  to  V2,  Ri  is  the  region  (or  face  in  the  terminology  of  computational  geometry)  to  the  left  of 
the  edge,  and  R2  is  the  region  to  the  right.  Pi  is  a  pointer  to  the  edge-node  which  is  adjacent  to  edge  V|  V2  in 
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a  counterclockwise  rotation  about  Vi,  and  similarly  for  P2  with  respect  to  V2.  A  partial  listing  of  the  DCEL 
for  the  optimal-path  map  of  Figure  3  is  also  shown.  [Ref.  8] 

For  a  DCEL  representing  a  partition  with  n  vertices,  a  single  pass  in  time  0(n)  can  create  arrays  of 
headers  of  vertex  and  region  linked  Usts,  so  that  straightforward  algorithms  can  retrieve  the  sequence  of  edges 
incident  on  a  vertex  or  enclosing  a  region,  in  time  proportional  to  the  number  of  edges  involved.  A  graph  in 
edge-list  form  can  be  transformed  to  a  DCEL  in  time  0(n).  [Ref.  8] 

An  extension  of  the  DCEL  allows  curved  edges,  as  well  as  piecewise-linear  ones,  to  be  represented. 
Additional  Gelds  for  each  edge-node  can  be  added  to  the  DCEL  to  represent  the  algebraic  form  of  the  curve 
and  to  represent  additional  parameters  necessary  to  specify  the  curve  analytically.  For  example,  if  a  curve  rep- 
resented a  segment  of  a  hyperbola,  the  entry  in  the  first  additional  field  would  note  that,  and  the  second  addi- 
tional field  would  contain  the  two  parameters  of  the  equation  of  a  hyperbola.  Two  points  on  the  hyperbola,  the 
endpoints  of  the  segment,  are  hsted  in  the  DCEL,  so  the  hyperbola  segment  is  fully  specified. 

3.  The  Plane  Sweep  Paradigm 

Many  algorithms  in  computational  geometry  follow  the  plane  sweep  paradigm.  The  idea  is  to  process 
a  geometrical  structure  in  the  plane  in  an  ordered  fashion,  normally  by  sweeping  an  imaginary  vertical  line 
from  left  to  right  from  event  point  to  event  point,  where  an  event  point  is  a  point  in  the  plane  at  which  some 
action  may  need  to  be  taken.  Two  data  structures  are  useful  in  conducting  a  plane  sweep,  an  event-point 
schedule  and  a  sweep-line  status.  At  any  point  along  the  sweep  axis,  the  geometrical  structure  is  characterized 
by  a  status  which  is  the  relation  of  the  vertical  line  to  the  geometrical  structure.  For  example,  the  status  may 
be  an  ordered  list  of  line  segments  of  the  structure  which  intersect  the  sweep  line.  This  status  will  change  at  a 
finite  number  of  points  along  the  sweep  axis  for  a  finitely-describable  structure.  These  changes  in  status  are 
the  places  at  which  the  problem  must  be  processed  or  analyzed.  These  points  along  the  sweep  axis  are  main- 
tained in  the  event-point  schedule.  The  event-point  schedule  is  often  some  form  of  a  queue.  [Ref.  8] 

4.  Point-Location  in  the  Cartesian  Plane 

Linked  to  any  algoritlim  that  partitions  tlie  Cartesian  plane  in  order  to  represent  properties  of  points 
in  each  region  is  tlie  requirement  to  retrieve  those  properties  when  queried  about  any  point  in  the  plane  specified 
by  its  coordinates.  Algorithms  that  buUd  optimal-path  maps  are  partitioning  the  plane  into  regions  such  that 
each  region  contains  those  start  points  witli  similarly-behaved  optimal  paths  to  a  given  goal-point.  It  is  neces- 
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sary  to  detennine  in  which  region  the  point  lies.  If  the  boundaries  between  regions  are  piecewise-linear  cur- 
ves, there  are  several  algorithms  from  computational  geometry  which  can  be  used  to  locate  a  point  in  the  planar 
partition. 

The  slab  method  of  point  location  in  a  planar  partition  draws  a  horizontal  line  through  each  vertex  of 
the  partition,  and  then  sorts  the  regions  (or  slabs)  lying  between  horizontal  lines  from  top  to  bottom  during 
preprocessing.  This  allows  location  of  the  point  within  a  slab  in  0(log  n)  time  by  use  of  bisection  search  based 
on  the  y-coordinate  of  the  point,  where  n  is  the  number  of  vertices  in  the  partition.  Line  segments  which  com- 
prise the  boundaries  of  the  partition  cross  through  each  slab.  Within  a  slab  they  can  be  ordered  from  left  to 
right  because  at  no  point  in  the  interior  of  a  slab  do  two  line  segments  intersect,  since  the  slabs  were  defined 
by  drawing  horizontal  lines  through  all  the  intersection  points  of  the  partition.  Then  bisection  search  can  be 
used  to  locate  the  point  horizontally  between  line  segments  within  the  slab  in  0(log  n)  time,  for  a  total  loca- 
tion time  of  0(log  n  +  log  n)  =  0(log  n).  Two  disadvantages  to  this  method  are  the  requirement  forpreprocess- 
ing  time  and  storage  space.  Preparata  and  Shamos  show  how  to  reduce  the  basic  0(n  log  n)  preprocessing 
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time  to  0(n  )  using  a  plane  sweep  approach,  but  the  algorithm  requires  at  worst  0(n  )  space.  [Ref.  8] 

A  second  point-location  method  is  the  cluiin  method.  Instead  of  dividing  the  planar  graph  horizon- 
tally with  slabs,  it  finds  vertical  cliains,  or  connected  Une  segments,  of  edges,  which  are  monotone  with  respect 
to  the  y-axis,  i.e.,  such  that  no  two  points  on  the  chain  have  the  same  y-coordinate.  It  then  constructs  two  bi- 
nary search  trees,  the  first  having  those  chains  as  nodes  and  the  second  having  segments  of  chains  as  nodes. 
The  two  trees  can  be  traversed  in  0(log  n)  time  to  locate  a  point.  A  DCEL  can  be  preprocessed  in  0(n  log  n) 
time  into  the  two  binary  search  trees,  which  take  at  worst  0(n)  space.  [Ref.  8] 

Another  point-location  method  is  the  triangulation  refinement  metliod.  A  set  of  connected  Une  seg- 
ments is  said  to  be  triangulated  if  each  vertex  is  connected  by  a  line  segment  with  at  least  two  other  vertices, 
i.e.,  the  line  segments  all  fonn  triangles.  The  planar  partition  is  triangulated  in  0(n  log  n)  time  by  standard 
methods  from  computational  geometry,  and  a  hierarchy  of  triangulations  is  constructed  upon  which  to  search. 
This  method  leads  to  O(log  n)  query  time,  0(n  log  n)  preprocessing  time,  and  0(n)  storage.  [Ref.  8] 

An  extension  of  the  chain  method,  tlie  bridged  cliain  method,  uses  an  elegant  method  that  permits 
search  in  O(constant)  time  for  subsequent  searches,  after  a  higher  cost  for  a  first  search.  It  happens  that  the 
chain  method  meets  the  conditions  for  application  of  the  bridging  technique,  and  so  bridging  is  used  to  ac- 
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cumulate  information  during  the  search  process.  This  technique  brings  the  chain  method  to  efficiency  com- 
parable with  the  triangulation  refinement  method.  [Ref.  8] 

Although  the  above  two  methods  achieve  the  theoretically  q>timum  worst-case  bounds,  there  may 
be  sub-optimal  methods  which  afford  better  practical  perfonnance.  Specifically,  the  trapezoid  method,  which 
could  be  considered  an  extension  of  the  slab  method,  gives  an  0(log  n)  query  which  always  succeeds  in  fewer 
than  4riog  n  1+  3  tests,  and  uses  0(n  log  n)  storage  and  preprocessing  time.  Actually,  average-case  storage 
may  be  0(n).  This  method  has  the  additional  property  that  it  may  be  extended  to  curvilinear  edges,  so  it  may 
be  especially  useful  in  our  application  since  instead  of  approximating  curves  piecewise-linearly,  they  may  be 
represented  exactly  by  their  analytical  form.  [Ref.  8] 

A  problem  with  the  slab  method  was  the  0(n  )  worst-case  space  complexity,  where  n  is  the  number 
of  vertices  of  the  graph  representing  the  planar  partition.  This  problem  was  due  to  the  possibility  that  edges 
could  span  most  of  the  horizontal  slabs,  each  such  edge  needing  to  be  segmented  into  0(n)  fiagments.  In  the 
trapezoid  method,  it  can  be  shown  that  no  more  than  2  log  n  fragments  will  ever  be  needed  for  any  edge,  so 
no  more  than  0(n  log  n)  space  is  required.  The  trapezoid  method  defines  a  trapezoid  as  having  two  horizon- 
tal sides  and  two  other  sides  which  may  be  unbounded,  or  else  if  they  exist  are  edges  of  the  gr^h  not  inter- 
rupted by  vertices.  The  basic  operation  of  tlie  algorithm  is  to  split  a  trapezoid  into  subordinate  trapezoids.  The 
progress  of  the  splitting  algorithm  is  paralleled  by  the  building  of  a  balanced  binary  search  tree  which  repre- 
sents a  hierarchy  of  subordinate  trapezoids.  This  tree  can  then  be  searched  to  locate  a  point  in  a  trapezoid. 
Figure  4  (adapted  from  Preparata  and  Shamos  [Ref.  8])  shows  an  example  trapezoid  with  its  corresponding 
search  tree. 

The  splitting  operation  for  the  trapezoid  method  proceeds  by  finding  the  median  y-coordinate  among 
the  vertices  contained  in  the  current  trapezoid  T  and  dividing  T  into  two  "slices"  Ti  and  T2  by  drawing  a 
horizontal  line  through  the  median  vertex.  Then  those  edges  which  intersect  the  top  or  bottom  horizontal  side 
of  T  are  scanned  from  left  to  right,  and  the  first  edge  which  also  intersects  the  newly  drawn  horizontal  line, 
i.e.,  which  spans  Ti  or  T2,  defines  a  new  trapezoid  T3.  The  scan  continues  until  all  edges  which  span  Ti  or  T2 
are  found,  with  a  new  trapezoid  being  generated  for  each  spaiming  edge.  Note  that  edge  ei  defines  the  first 
new  trapezoid  T3  in  Figure  4  because  it  spans  the  top  and  median  lines  of  T.  T3  wUl  not  need  to  be  further  split 
because  tliere  are  no  vertices  contained  in  it.  Spanning-edge  e2  is  found  next,  and  creates  T6.  Finally  es  is 
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Figure  4 
Trapezoid  Metliod  of  Point  Location 
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found,  creating  T4.  No  other  spanning  edges  are  found,  so  T5  and  T7  are  also  defined.  T4,  T5,  Te,  and  T7  all 
contain  vertices  of  the  graph  in  their  interiors,  so  they  will  need  to  be  split  further  in  subsequent  iterations  of 
the  algorithm.  Triangular  nodes  of  the  search  tree  represent  horizontal  splits  at  graph  vertices,  while  circular 
nodes  represent  the  definition  of  new  trapezoids  by  spanning  edges.  There  will  be  n-2  triangular  nodes  of  the 
tree,  one  for  each  except  the  left  and  right  extreme  vertices  of  the  graph.  Edges  may  form  the  sides  of  more 
than  one  trapezoid,  however,  in  fact  they  may  be  fragmented  into  as  many  as  2  log  n  segments,  as  stated  above. 
Thus  the  search  tree  may  have  as  many  as  0(u  log  n)  nodes,  which  is  the  worst-case  space  complexity.  The 
tree  corresponding  to  the  trapezoids  found  in  Figure  4  is  also  shown. 

The  depth  of  the  balanced  search  tree  can  be  shown  to  be  no  more  than  4 1  log  n  1+  3,  so  a  search  of 
the  tree  will  take  no  more  than  that  many  steps.  Thus  the  worst-case  time  complexity  to  locate  a  point  in  the 
planar  partition  is  0(log  n).  Since  there  are  0(n)  edges  and  each  edge  may  be  segmented  into  0(log  n)  frag- 
ments, the  time  required  to  process  the  edges  is  0(n  log  n),  while  both  the  median-finding  and  the  iree-balaiK- 
ing  may  be  done  in  0(n  log  n)  time.  Thus  the  preprocessing  required  is  0(n  log  n). 

An  added  advantage  which  could  be  useful  to  our  research  is  that  the  trapezoid  method  can  be  ex- 
tended in  some  cases  to  finding  a  point  among  edges  which  are  not  straight-line  segments.  This  can  be  done 
if  first,  the  curves  can  be  expressed  as  a  single-valued  function  of  one  of  the  coordinates,  and  second,  if  it  can 
be  determined  in  constant  time  whether  a  point  is  on  one  side  or  the  other  of  the  curve. 
5.     Intersections  Among  Line  Segments  in  the  Cartesian  Plane 

A  common  operation  of  the  algorithms  proposed  in  Chapter  VI  is  to  find  intersections  between  two 
piecewise-linear  curves.  It  is  thus  important  to  fiind  efficient  methods  of  doing  this  operation.  The  intersection 
of  two  piecewise-linear  curves  with  p  and  q  segments  resj>ectively  would  take,  using  the  naive  approach  which 
compares  each  segment  of  one  curve  with  each  segment  of  the  other,  0(pq)  line  segment  intersections,  so  it 
is  important  to  find  belter  ways  of  doing  the  operation. 

Preparata  and  Shamos  present  an  algorithm  to  find  all  intersecUons  among  n  line  segments  by  per- 
forming a  plane  sweep  along  the  x-axis.  At  any  point  on  the  x-axis,  a  vertical  line  imposes  a  total  order  on 
those  line  segments  it  intersects.  This  order  is  recorded  in  the  sweep-hue  status.  As  the  vertical  Une  sweeps  to 
the  right  from  intersection  point  to  intersection  point,  new  line  segments  may  be  added  to  the  ordering,  and 
old  ones  deleted,  but  if  any  adjacent  pair  of  line  segments  changes  order,  which  is  delected  by  a  change  in  the 
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sweep-line  status,  an  intereection  of  those  segments  must  have  occurred.  Thus,  any  line  segment  which  is  added 
to  the  ordering  is  checked  for  intersection  with  the  segment  immediately  above  and  below  it  by  checking  if 
the  relative  order  changes  at  the  point  along  the  x-axis  where  the  first  of  the  two  segments  will  be  deleted.  This 
approach  can  detect  k  intersections  among  n  line  segments  where  n  is  p+q  in  time  0((n+k)  log  n).  In  our  domain 
however,  any  two  homogeneous-behavior-region  boundaries  will  intersect  in  at  most  one  point,  because  when 
any  two  boundaries  intersect,  a  third  boundary  will  begin  and  the  other  two  will  end.  Therefore  we  could  use 
a  simplification  of  the  above  algorithm  which  will  operate  in  0(n  log  n)  time.  [Ref.  8] 

Intersection  calculation  for  piecewise-linear  curves  with  monotonic  curvature  can  exploit  these 
properties.  Several  algorithms  of  uncertain  worst-case  complexity  seem  to  provide  good  empirical  results.  One 
in  particular  [Ref.  9]  proceeds  by  constructing,  in  0(p)  time,  a  bounding  box  for  the  first  piecewise  linear 
curve,  and  then  checking,  in  0(q)  time,  which  portion  of  the  second  curve,  if  any,  intersects  the  bounding  box. 
The  intersecting  portion  of  the  second  curve  usually  contains  only  a  small  fraction,  call  it  ki,  of  the  whole 
curve,  although  it  is  at  this  point  that  the  analysis  becomes  imprecise  because  ki  does  not  depend  on  p  or  q, 
but  on  the  curvature  and  relative  positions  of  the  two  curves.  In  any  case,  the  next  step  is  to  reverse  the  roles 
of  the  two  curves  and  create  another  bounding  box  about  the  kiq  line  segments  of  the  second  curve,  in  O(kiq) 
time.  The  first  curve  is  intersected  with  the  new  bounding  box  in  0(p)  time,  finding  k2p  segments  which 
traverse  the  new  box.  The  algorithm  proceeds  recursively  as  above,  terminating  when  one  of  the  bounding 
boxes  contains  only  one  line  segment.  At  this  point,  the  next  check  of  the  other  curve  will  yield  the  exact  in- 
tersection point.  A  rough  approximation  of  the  time  complexity  of  this  algorithm,  if  it  is  assumed  for  simplicity 
that  at  each  stage  the  size  of  the  curve  is  reduced  by  the  same  fraction  k,  is  T  =  ((l+k)q  +  2p)/(l-k)  +  1.  Thus 
this  algorithm  has,  assuming  0<k<l,  time  complexity  0(q+2p)  =  0(q+p)  =  0(n).  This  algorithm  will  not  con- 
verge if  at  any  stage  the  bounding  box  of  each  partial  curve  completely  contains  the  other  partial  curve.  But  a 
simple  check  during  each  iteration  to  ensure  that  the  sizes  of  the  two  curves  are  in  fact  decreasing  will  allow 
the  method  to  proceed  if  it  is  converging.  If  it  fails  this  test,  a  fiill  0(pq)  test  of  the  two  curves  can  be  used  in- 
stead. 

6.     Voronoi  Diagrams 

A  technique  in  computational  geometry  that  has  been  of  use  in  some  algorithms  pertaining  to  op- 
timal-path maps  is  Voronoi  diagram  consliuction  [Ref.  8].  A  Voronoi  diagram  Vor(S)  with  respect  to  a  set  of 
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points  S  in  a  plane  is  the  partition  of  the  plane  such  that  each  region  contains  the  points  with  the  same  nearest 
neighbor  in  S.  Figure  5  shows  a  typical  Voronoi  diagram.  One  method  for  constructing  shortest -path  maps 
(i.e.,  an  optimal-path  map  for  binary  terrain),  uses  an  extension  of  Voronoi-diagram  methodology  to  plot  ap- 
proximations of  the  boundaries  between  homogeneous-behavior  regions  [Ref.  4].  It  reduces  the  problem  of 
constructing  the  planar  partition  to  that  of  finding  a  Voronoi  diagram  for  the  vertices  of  an  obstacle,  where  the 
costs  of  optimal  paths  from  each  vertex  is  known.  Instead  of  bisectors  between  two  vertices  which  are  straight 
lines  exactly  half-way  between  them  as  described  below,  this  method  constructs  bisectors  which  are  either 
lines  or  hyperbola  branches,  depending  on  the  nature  of  the  paths  from  the  two  vertices.  Then  the  Voronoi 
diagrams  of  single  obstacles  are  merged  to  form  the  complete  0PM. 

Some  observations  about  Voronoi  diagrams  lead  to  an  initial  construction  method.  Between  two 
points  P I  and  P2  in  the  plane,  the  set  of  points  closer  to  P|  than  to  P2  are  the  points  in  a  half-plane  containing 
Pi  defined  by  the  perpendicular  bisector  of  the  line  segment  P1P2.  Among  a  set  S  of  n  points  in  the  plane,  the 
set  of  points  closer  to  a  point  Pi  than  to  any  other  point  in  S  is  the  intersection  of  n-1  half-planes  each  contain- 
ing Pi  defined  by  the  perpendicular  bisectors  of  the  line  segments  PiPj.  From  this  observation,  a  bnite-force 
method  of  constructing  a  Voronoi  diagram  would  be  simply  to  construct  each  of  the  n  polygons  about  each 
point  in  S.  Since  n  half-planes  can  be  intersected  with  each  other  in  0(n  log  n)  time  by  a  divide-and-conquer 
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approach,  this  approach  takes  time  0(n  log  n).  [Ref.  8] 

A  more  efficient  approach  for  constructing  Voronoi  diagrams  which  also  uses  the  divide-and-con- 
quer paradigm  can  be  summarized  as  follows.  First,  partition  S  into  two  sets  Si  and  S2  of  roughly  equal  size 
according  to  whether  the  x-coordiuate  of  each  point  is  less  than  or  greater  than  the  median  x-coordinate  of 
points  in  S.  Then,  construct  Vor(Si)  and  WoriSj)  recursively,  and  finally,  merge  Vor(Si)  and  Vor(S2)  to  ob- 
tain Vor(S).  Partitioning  S  takes  0(n)  time  for  a  set  S  of  size  n  using  a  standard  median-finding  algorithm  and 
the  merging  step  takes  0(n)  time.  If  the  entire  algorithm  can  be  performed  in  T(n)  steps,  the  construction  of 
both  subordinate  Voronoi  diagrams  in  step  two  takes  approximately  2T(n/2)  time.  So  the  recurrence  relation 
T(n)  =  2T(n/2)  -f-  0(n)  describes  the  algorithm,  which  when  solved  gives  that  T(n)  is  0(n  log  n). 

The  merging  step  is  the  heart  of  the  algoritlun,  and  is  accomplished  as  follows.  Because  the  map  is 
partitioned  such  that  Si  and  S2  will  he  on  opposite  sides  of  a  vertical  Une,  it  can  be  shown  tliat  there  is  a  chain 
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Voronoi  Diagram 
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<y,  i.e.,  a  sequence  of  connected  line  segments,  wliich  is  monotonic  with  respect  to  the  y-axis,  (i.e.,  no  two 
points  of  the  chain  have  the  same  y-coordinate)  that  also  partitions  the  plane  with  Si  and  S2  on  opposite  sides 
of  (J  such  that  the  union  of  the  portion  of  Vor(S  i )  which  is  left  of  a  and  the  portion  of  YoriSi)  which  is  right 
of  (J  yields  Vor(S).  In  fact  this  chain  O  can  be  constnicted  in  linear  time,  so  the  recunence  relation  stated 
above  holds,  and  the  construction  of  a  Voronoi  diagram  can  be  done  in  0(n  log  n)  time.  [Ref.  8] 

Generalizations  of  Voronoi  diagrams  have  been  presented  which  partition  the  plane  into  sets  of  points 
closest  to  a  set  of  line  segments  [Ref.  10],  or  which  base  their  distance  function  on  metrics  other  than  the 
Euclidean  metric  [Ref.  11].  Since  OPMs  for  homogeneous-cost  areas  can  be  thought  of  as  Voronoi  diagrams 
with  a  different  metric  for  each  homogeneous-behavior  region,  the  latter  work  seems  promising.  Currently, 
however,  only  several  simple  metrics  such  as  Li  and  Loohave  been  considered,  so  more  research  in  this  area 
is  necessary  before  OPMs  of  the  type  we  are  considering  can  be  constructed  with  this  approach.  Weighted 
Voronoi  diagrams  [Ref.  12]  assign  a  weight  to  each  point  about  which  regions  are  computed.  This  concept 
might  appear  useful  in  constructing  OPMs,  but  is  not.  Instead  it  applies  to  a  problem  in  which  a  mobile  agent 
travels  at  different  speeds  depending  on  which  terrain-feature  vertex  it  just  crossed. 

What  is  needed  in  constructing  OPMs  for  the  binary  case  is  a  type  of  generalized  Voronoi  diagram 
in  which  the  weight  is  the  cost-rate  of  the  region  in  which  an  obstacle  vertex  lies,  and  an  offset  of  the  initial 
weight  at  the  vertex  represents  the  cost  of  the  optimal  path  from  the  vertex.  This  is,  in  essence,  what  the  algo- 
rithm of  Aronov  [Ref.  13]  computes.  This  algorithm  allows  points  in  the  Voronoi  set  to  be  given  an  initial  of- 
fset weight.  Knowing  that  bisectors  between  such  points  are  hyperbolas  (or  in  the  degenerate  case,  lines),  they 
can  be  plotted  just  as  in  the  basic  Voronoi  diagram  algorithm.  The  key  element  of  the  method  is  the  proof  that 
a  dividing  chain  can  be  constructed  between  two  Voronoi  diagrams  as  discussed  above,  which  now  can  con- 
tain hyperbola  segments  as  well  as  line  segments.  This  allows  smaller  generalized  Voronoi  diagrams  to  be 
merged  into  larger  ones,  which  is  the  foundation  of  the  divide-and-conquer  approach  used. 

C.    DEFINITIONS  OF  RELEVANT  FREE-SPACE  PATH-PLANNING  PROBLEMS 

This  thesis  addresses  problems  where  the  mobile  agent  is  of  negligible  size  with  respect  to  the  surround- 
ing terrain,  where  terrain  is  two-dimensional  free  space  with  fixed  terrain  features,  where  tlie  environment  is 
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stable  and  knowledge  about  it  is  complete,  and  where  the  optimality  criterion  is  to  minimize  a  cost  function 
which  is  linear  in  path  length. 

A  simplified  version  of  this  problem  has  been  called  by  Lozano  and  Wesley  [Ref.  1]  and  Brooks  [Ref. 
14]  the  FIND-PATH  Problem,  and  by  MitcheU  [Ref.  15]  the  OBSTACLE- AVOIDANCE  Problem.  This 
simplified  problem  seeks  any  feasible  path  in  terrain  consisting  of  impassable  obstacles  on  a  homogeneous- 
cost  background.  An  important  extension  to  the  FIND-PATH  Problem  includes  the  optimality  criterion  that 
the  resulting  path  be  the  shortest  among  all  feasible  paths.  It  is  called  the  OBSTACLE-AVOIDANCE 
SHORTEST-PATH  Problem,  or  simply  the  SHORTEST-PATH  Problem. 

OBSTACLE-AVOIDANCE  SHORTEST-PATH  Problem:  Given  a  mobile  agent  A  of  negU- 
gible  size  with  respect  to  the  environment,  an  environment  E  consisting  of  impassable  obstacles  at 
fixed  and  known  locations  on  a  homogeneous-cost  background,  and  motion  objective  O  consisting 
of  the  translation  of  A  to  a  specified  goal  point  in  the  environment,  find  a  continuous  path  n  for  A 
amidst  E  that  achieves  objective  O  such  that  its  length  is  minimal  among  all  feasible  paths,  or  report 
tliat  no  feasible  path  exists. 

Realistic  terrain  for  large-scale  cross-country  path-planning  can  rarely  be  modelled  as  binary  (i.e., 

obstacles  on  a  homogeneous-cost  background).  A  more  useful  assumption  is  that  terrain  can  be  modelled  as 

homogeneous-cost  regions.  The  map  is  consists  of  regions,  each  assigned  a  value  representing  the  cost  rate  to 

the  agent  to  traverse  the  region.  The  weighted-region  problem  is  a  generalization  of  the  obstacle-avoidance 

shortest-path  problem  which  defines  terrain  as  homogeneous-cost  regions. 

WEIGHTED-REGION  Problem:  Given  a  mobile  agent  A  of  negligible  size  with  respect  to  en- 
vironment E,  E  consisting  of  a  partition  of  the  plane  into  fixed  homogeneous-cost  regions  of  known 
position,  and  motion  objective  O  consisting  of  the  translation  of  A  to  a  specified  point  in  environ- 
ment E,  find  a  continuous  path  K  for  A  amidst  E  that  achieves  objective  O  such  that  the  path  in- 
tegral of  the  cost  is  minimal,  or  report  that  no  feasible  path  exists. 

The  U.S.  Army  Engineer  Waterways  Experiment  Station,  the  U.S.  Army  Engineer  Topographic 

Laboratories  (ETL)  and  the  Defense  Mapping  Agency  (DMA)  currently  can  produce  such  cost-rate  maps  of 

environments  E  using  a  program  called  Army  Mobility  Model  (AMM),  for  portions  of  the  earth  for  which 

digitized  terrain  data  is  available.  This  data  includes  not  only  elevation  data,  but  cultural,  vegetation,  and  soil 

data  as  well,  and  must  currently  be  collected  in  part  manually  [Ref.  16].  The  output  of  AMM  is  a  map  in  which 

terrain  is  subdivided  according  to  the  maximum  speed  with  which  the  given  vehicle  could  be  expected  to 

traverse  the  terrain. 
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If  an  application  will  require  repeated  solutions  of  the  shortest-path  or  weighted-region  problems,  it  may 

be  more  efficient  to  construct  an  optimal-path-map  which  represents  optimal  paths  to  a  given  goal  point  from 

all  start  points  in  the  plane.  If  the  output  map  represents  solutions  to  the  shortest-path  problem,  it  is  called  a 

shortest-path-map.  Some  authors  use  shortest-path-map  to  refer  to  maps  of  the  weighted-region  problem  as 

well,  allowing  the  word  shortest  to  mean  shortest  with  respect  to  a  specified  cost  fiinclion.  We  prefer  the  term 

optimal-path-map,  however,  to  emphasize  its  basis  in  the  weighted-region  problem. 

FIXED-GOAL  OPTIMAL-PATH-MAP  Problem:  Given  mobile  agent  A  of  negligible  size  with 
respect  to  environment  E,  E  consisting  of  a  partition  of  the  plane  into  fixed,  homogeneous-cost 
regions  of  known  position,  and  a  set  of  motion  objectives  0  which  are  to  translate  agent  A  from 
each  of  the  continuum  of  start  points  S  in  the  plane  to  a  goal  point  G,  represent  tlie  set  11  of  con- 
tinuous paths  for  A  in  E  that  achieves  objectives  Oi  in  0  such  that  the  path  integral  for  each  7li  is 
minimal  over  all  paths  from  start  point  S\  to  G,  or  report  that  no  feasible  path  exists. 

D.    TYPES  OF  PATH  ERRORS 

Several  classes  of  errors  may  occur  in  algorithms  which  look  for  optimal  paths.  Each  algorithm  is  based 
on  a  model  of  the  path-planning  domain  with  its  own  representation  of  reality,  and  operations  manipulate  that 
representation  to  produce  a  solution.  For  example,  terrain  in  some  models  is  represented  by  imposing  a  grid 
on  the  map  and  assigning  a  cost  to  each  cell  of  the  grid,  wliile  in  some  models  terrain  is  represented  by  polygons 
witli  an  assigned  cost.  Errors  may  occur  either  because  of  inaccuracies  in  operations  within  the  model  or  be- 
cause of  inaccuracies  in  the  model  compared  with  the  real-world  domain.  The  first  class  below  are  errors  of 
the  former  type,  while  the  second  and  third  classes  are  errors  of  the  latter  type. 

1.     Cost  of  Model  Computed  Path  versus  Cost  of  Model  Optimal  Path 

Path-planning  algorithms  execute  within  the  context  of  their  model  of  real-world  terrain.  If  an  algo- 
rithm produces  a  solution  path  which  has  a  computed  cost  greater  than  the  minimum  cost  of  some  other  path 
represented  within  the  model,  the  algoritlun  has  produced  a  model  sub-optimal  path.  Such  a  solution  may  occur 
either  intentionally  or  unintenfionally.  Some  algorithms  terminate  when  a  candidate  solution  Ls  guaranteed  to 
be  within  some  bound  of  the  true  model  optimal  solution,  thus  saving  processing  time  at  the  expense  of  ac- 
curacy. An  example  of  this  type  of  algorithm  is  a  variation  of  A*  called  A*e  [Ref.  17].  Another  example  of 
an  algorithm  which  produces  solutions  with  this  kind  of  error  is  called  simulated  annealling.  It  uses  stochas- 
tic methods  to  determine  when  a  candidate  solution  has  a  high  probability  of  being  good  enough  [Ref.  1 8J.  Er- 
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rors  of  this  type  also  occur  because  of  numerical  errors  in  the  mathematical  operations  performed  by  the  al- 
gorithm. Standard  numerical  analysis  techniques  can  be  used  to  study  these  errors  and  attempt  to  reduce  them. 

2.  Cost  of  Model  Optimal  Path  versus  Cost  of  Real-World  Optimal  Path 

When  the  cost  of  the  optimal  path  within  the  model  is  different  from  the  actual  cost  of  a  path  between 
the  same  two  points  in  the  real  world,  an  error  of  the  second  class  has  occurred.  Even  the  actual  measurement 
of  a  path  cost  is  only  an  approximation  of  reality,  so  any  model  produces  at  least  some  small  error  of  this  kind. 
The  amount  of  this  kind  of  error  produced  is  an  important  consideration  in  choosing  among  algorithms.  For 
example,  as  discussed  in  Section  E  below,  the  wavefront  propagation  algorithm  may  produce  solutions  which 
are  optimal  in  its  grid-based  model,  but  which  have  as  much  as  7.6%  greater  cost  than  an  actual  path  between 
the  same  two  points  as  measured  io  the  real  world. 

3.  Location  of  Model  Optimal  Path  versus  Location  of  Real-World  Optimal  Path 

A  model  optimal  path  could  still  be  a  valuable  representation  of  a  real-world  optimal  path  despite  a 
larger  cost  than  the  true  optimal  cost  if  its  qualitative  behavior  was  similar  enough  to  the  path  it  represented. 
But  algorithms  may  produce  solutions  which  follow  quite  different  routes  than  the  real-worid  optimal  path. 
As  discussed  by  Mitchell  and  Kiersey  [Ref.  19],  the  grid-based  model  upon  which  wavefront  propagation  (see 
Section  E  below)  is  based  allows  for  multiple  paths  with  the  model  optimal  cost,  so  only  the  details  of  the  al- 
gorithm implementation  determine  which  one  is  reported  as  the  solution,  and  that  repotted  solution  may  dif- 
fer markedly  from  the  true  optimal  path.  This  type  of  error  may  or  may  not  be  important  depending  on  the 
appUcation  to  which  the  results  will  be  applied. 

E.    RELEVANT  OPTIMAL-PATH  PLANNING  RESEARCH 

A  taxonomy  for  categorizing  free-space  path-planning  methods  is  presented  in  Figure  6.  Algorithms  for 
free-space  path  planning  generally  transform  an  infinite  search  space  into  a  finite  one  by  eliminating  all  but  a 
finite  number  of  candidate  paths,  and  then  searching  this  finite  space  using  standard  techniques  such  as  branch- 
and-bound  or  A*  search.  Two  distinct  ways  used  to  effect  this  transformation  to  a  finite  search  space  are  map 
discretization  and  spatial  reasoning. 


28 


PATH-PLANNING 
IN  FREE  SPACE 


Algorithn/ reduces  the'^oblem 
represGntation  to  graph  mrm. 


SPATIAL 
REASONING 


BLIND 
SEARCH 


Uses  reasoning/about\erra 
effects  on  ©ptimal 
beha/'ior 


Sea^hes 
wholA  search 
space 


Figure  6 
Taxonomy  of  Free-Space  Path-Planning 
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1.     Map  Discretization  -  Wavefront  Propagation 

Map  discretization  methods  j^proximate  the  terrain  by  imposing  a  tesseiation  on  the  map  and 
categorizing  each  cell  according  to  the  tenrain  it  overiays,  and  allow  travel  only  between  centers  of  grid  cells. 
Alternate  representations  are  possible,  for  example,  where  travel  is  allowed  between  comers  of  cells.  Since 
there  are  a  finite  number  of  cells,  there  are  a  finite,  though  large,  number  of  candidate  paths  (assuming  cycling 
is  prevented).  A  method  popular  for  its  simplicity  is  called  wavefront  propagation  (see  Figure  7)  [Ref.  15], 
[Ref.  20].  The  terrain  is  approximated  by  a  square  tesseiation  of  the  map,  and  paths  are  approximated  by  al- 
lowing motion  only  from  the  center  of  a  cell  to  the  center  of  an  adjacent  cell.  Eight-neighbor  adjacency  is 
usually  used,  meaning  that  from  a  cell,  the  agent  may  move  to  any  of  the  four  perpendicularly  adjacent  cells 
or  to  any  of  the  four  diagonally  adjacent  cells.  Because  of  the  restrictions  on  directions  of  movement,  eight- 
neighbor  wavefront  propagation  has  as  much  as  7.6%  inaccuracy  in  that  a  reported  solution  may  cost  as  much 
as  7.6%  more  than  the  real-world  optimal  path  [Ref.  20].  Normally  Dijkstra's  algorithm  (branch-and-bound 
search)  is  used  to  expand  in  all  directions  from  the  start  point  until  the  goal  is  first  reached.  The  name  wavefront 
propagation  is  used  because  of  the  analogy  of  the  expansion  of  a  circular  wave  in  water. 

The  implementation  of  wavefront  propagation  reported  by  Richbourg  [Ref.  21]  is  a  variation  of 
Dijkstra's  algorithm  which  models  the  expansion  of  the  wavefront  explicitly.  The  basic  mechanism  is  that  time 
is  incremented  in  fixed  units,  and  at  each  time  increment  the  wavefront  is  propagated  outward  as  far  as  it  can 
travel  through  each  cell  currently  on  the  wavefront.  Each  cell  which  is  reached  by  the  wavefront  is  added  to 
the  wavefront  list,  and  when  the  cell's  cost  has  been  decremented  below  zero  it  is  dropped  off  the  wavefront 
Ust.  During  each  iteration,  cells  tlu-ough  wliich  the  wavefront  has  fiilly  passed  will  propagate  the  wave  to  each 
of  their  neighbors.  If  the  neighbor  cell  has  not  yet  been  reached  by  the  wavefront  a  back-pointer  is  set  back  to 
the  cell  on  the  wavefront  and  the  neighbor  cell's  cost  is  decremented  according  to  how  far  the  wavefront  can 
travel  through  it  in  a  unit  of  time.  If  the  neighbor  cell  has  already  been  reached  by  another  cell  on  the  wavefront, 
no  action  will  be  taken  unless  the  neighbor  cell's  cost  could  be  decremented  further  by  the  currently  propagat- 
ing cell  than  it  was  decremented  by  the  previous  cell.  In  that  case,  the  pointer  is  changed  to  point  to  the  cur- 
rent cell  and  the  cost  is  set  accordingly. 
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If  cells  are  square  and  have  unit  dimensions,  time  could  be  advanced  in  increments  such  that  it  would 
take  1  time  unit  for  the  wave  to  pass  through  a  cell  of  unit  cost  in  an  orthogonal  direction  and  V2  time  units 
in  a  diagonal  direction.  For  a  cell  with  a  cost  of  c,  the  wave  will  take  c  and  cv  2  time  units  respectively.  Al- 
ternately, we  will  adopt  the  convention  that  time  is  incremented  in  units  of  V  2 ,  so  that  the  wave  will  progress 
vT /c  units  of  distance  through  a  cell  of  cost  c  in  the  orthogonal  direction  in  one  iteration,  and  1/c  distance  in 
the  diagonal  direction  in  one  iteration.  This  convention  provides  that,  for  cells  of  integral  cost,  diagonal  ex- 
pansion of  the  wave  will  always  end  inside  the  cell  or  at  its  edge,  never  overflowing  into  the  next  cell,  so  it  is 
only  in  the  orthogonal  direction  that  it  is  necessary  to  check  for  overflow.  Thus  we  decrement  the  original  cost 
associated  with  a  cell  by  1  or  by  VT  at  each  iteration,  and  when  the  remaining  cost  is  less  than  zero,  we  know 
that  the  wave  has  passed  completely  through  it.  Figure  7  illustrates  the  mechanics  of  the  wavefront  propaga- 
tion algorithm.  The  figure  shows  a  sequence  of  snapshots  of  the  algorithm,  where  the  remaining  cost  of  each 
cell  is  noted  inside  the  cell,  and  arrows  represent  pointers  to  each  parent  cell.  The  arrows  are  solid  when  the 
cell  has  been  added  to  the  wavefront,  and  dotted  when  the  cell  is  not  yet  on  the  wavefront  but  has  a  back- 
pointer assigned. 

For  a  map  of  m  cells,  the  worst-case  time  complexity  of  Dijkstra's  algorithm  is  0(m  log  m),  [Ref. 
15],  or  if  we  consider  the  two-dimensional  nature  of  the  input  map,  say  of  size  n  by  n  cells,  the  complexity  is 
0(n  log  n).  This  version  does  not  depend  on  the  costs  of  cells  on  the  map.  But  for  the  version  used  by  Rich- 
bourg,  time  complexity  is  also  a  function  of  initial  costs  of  the  cells.  Each  cell  will  remain  on  the  wavefront 
until  its  initial  cost  c  is  decremented  below  zero.  The  cell's  cost  will  be  decremented  by  1  or  V  2  at  each 
iteration,  so  each  cell  will  remain  on  the  wavefront  for  0(c)  iterations.  Each  iteration  that  a  cell  is  on  the 
wavefront,  its  eight  neighbors  will  be  checked  to  see  if  the  shortest  path  yet  to  the  neighbor  cell  is  through  the 
cell  being  considered,  or  through  some  already-processed  cell.  Thus  in  the  worst-case  where  aU  cells  have  a 
cost  Cmax,  if  we  assume  that  there  is  some  upper  bound  on  the  cost  of  cells,  the  worst-case  time  complexity  is 
0(Cmax  m).  In  terms  of  an  n  by  n  input  map,  the  worst-case  time  complexity  is  0(cmax  n  ).  We  must  for  theoreti- 
cal reasons  make  the  assumption  that  there  is  an  upper  bound  on  the  magnitude  of  Cmax,  because  if  Cmax  is  un- 
bounded, and  as  usual  is  represented  in  log  Cmax  bits,  we  have  that  the  size  of  the  input  map  is  1  =  0(log  Cmax), 
or  2  =  Cniax-  Tlius  the  worst-case  time  complexity  would  be  0(2  m).  As  explained  in  [Ref.  22],  tliis  type  of  al- 
gorithm has  pseudo-polynomial  time  complexity,  i.e.,  it  is  polynomial  if  the  input  size  is  bounded,  but  ex- 
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ponential  if  the  input  size  is  allowed  to  be  unbounded.  Both  versions  of  wavefront  propagation  have  space 
complexity  of  0(m). 

Dijkstra's  algorithm  examines  paths  in  all  directions  from  the  start  point,  regardless  of  which  are  like- 
ly to  lead  to  the  goal  point  quickest.  But  extending  the  algorithm  to  A*  search  by  introducing  an  evaluation 
function  gives  large  increases  in  execution  speed  by  focusing  the  search  on  paths  which  seem  to  be  proceed- 
ing in  the  best  directions.  The  evaluation  function  used  in  the  A*  version  of  wavefront  propagation  measures 
the  Euclidean  distance  from  the  cell  currently  being  considered  to  the  goal  cell.  Mitchell  and  Kiersey  [Ref. 
19]  report  an  increase  in  speed  for  A*  search  over  Dijkstra's  algorithm  of  1.5  to  20  times. 

Increased  resolution  of  the  tesselation  will  not  reduce  the  worst-case  inaccuracy  of  reported  solutions 
below  the  7.6%  upper  bound.  This  inaccuracy,  called  digitization  bias,  arises  because  of  the  discrete  ap- 
proximation of  paths.  The  only  way  to  reduce  the  upper  bound  on  error  caused  by  digitization  bias  is  to  in- 
crease the  number  of  possible  directions  the  mobile  agent  is  allowed  to  travel.  Sixteen-neighbor  wavefront 
propagation,  for  example,  allows  paths  between  a  cell  and  the  sixteen  cells  which  are  separated  from  it  by  one 
cell.  Richbourg  [Ref.  20]  showed  how  sixteen-neighbor  adjacency  could  decrease  the  inaccuracy  to  ap- 
proximately 1.9%. 

Not  only  does  digitization  bias  lead  to  inaccuracy,  it  also  means  that  multiple  solution  paths  could  be 
reported  depending  on  implementation  details  of  the  algorithm.  Path  representations  approximate  the  true  op- 
timal path  in  the  actual  terrain  by  connected  line  segments  which  lie  in  allowed  directions.  So  a  true  optimal 
path  which  for  example  lies  at  a  22.5°  angle  with  the  horizontal  could  be  represented  by  one  which  starts  in  a 
45°  direction,  and  then  fuiishes  in  a  horizontal  direction,  or  it  could  be  represented  by  one  which  alternates 
many  times  between  small  45°  line  segments  and  horizontal  Une  segments,  somewhat  like  computer  graphics 
routines  represent  Unes  with  sets  of  pixels.  The  latter  representation  is  to  be  preferred  because  it  more  close- 
ly approximates  the  true  optimal  path,  and  some  researchers  have  proposed  ways  to  augment  wavefront 
propagation  algorithms  to  favor  paths  which  have  more  regular  turns,  so  as  to  better  approximate  line  seg- 
ments. [Ref.  19],  [Ref.  20],  [Ref.  23],  [Ref  24],  [Ref.  25] 

Mitchell  and  Kiersey  [Ref.  19]  discuss  an  implementation  of  wavefront  propagation  called  BITPATH 
which  partially  compensates  for  digitization  bias  by  modifying  the  way  in  which  path  distances  are  computed. 
Vossepoel  and  Snieulders  [Ref.  26]  developed  an  estimate  for  the  actual  distance  over  a  true  optimal  path  given 
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a  digitized  approximation  which  lowers  the  estimate  each  time  the  approximation  path  turns,  based  on  the  idea 
that  each  turn  point  suggests  overestimation  of  Euclidean  distance.  BITPATH  incorporates  this  estimate  as 
the  cost  function  of  A*,  i.e.,  the  value  assigned  to  a  cell  to  represent  the  cost  of  the  best  path  from  the  start  cell. 
They  claim  a  significant  improvement  in  BITPATH's  ability  to  find  a  solution  which  not  only  has  minimum 
cost  of  all  possible  paths,  but  also  lies  close  to  the  true  optimal  path.  [Ref.  19] 

In  an  attempt  to  reduce  the  dependency  of  accuracy  on  resolution,  data  representation  schemes  that 
use  multiple  resolutions  have  been  introduced  which  use  hierarchical  algorithms  which  are  generalizations  of 
wavefront  propagation  [Ref.  27].  One  such  scheme  uses  quad-trees  to  represent  larger  homogeneous  areas 
with  single  cells  [Ref.  28].  With  this  approach,  rectangles  are  inscribed  within  homogeneous-cost  regions  of 
the  input  map,  and  then  successively  smaller  rectangles  fill  out  the  shape  of  the  regions.  This  representation 
is  then  searched  much  the  same  as  in  wavefront  propagation. 

A  parallel  processing  approach  to  wave  front-propagation  path  planning  has  been  implemented  in  sup- 
port of  the  DARPA -sponsored  autonomous  land  vehicle  built  by  Martin  Marietta  [Ref.  29].  Multiple  proces- 
sors are  utilized  to  sweep  horizontal  bands  of  the  map,  at  each  cell  replacing  the  current  cost  of  its  neighbors 
if  the  current  cost  of  the  cell  plus  the  cost  to  move  to  the  neighbor  is  less  than  the  neighbor's  current  cost.  Mul- 
tiple sweeps  are  employed  untU  the  cost  values  stabilize.  Richbourg  [Ref.  20]  suggests  an  alternative  based  on 
mesh-connected  architectures  in  which  computational  elements  in  the  architecture  would  model  cells  in  the 
map,  yielding  an  0(n)  algorithm,  and  Jorgenson  [Ref.  30]  presents  a  wavefront  propagation  implementation 
on  a  neural-network  machine. 

2.     Spatial  Reasoning  Methods 

Spatial  reasoning  uses  principles  about  how  optimal  paths  must  behave  in  the  presence  of  terrain  fea- 
tures to  constrain  the  search  space  for  optimal  paths.  A  simple  example  of  this  type  of  reasoning  is  that  op- 
timal paths  are  always  straight  lines  across  homogeneous  terrain,  and  in  the  case  of  binary  terrain  (obstacles 
on  a  homogeneous-cost  background),  turn  only  at  obstacle  vertices  (see  Theorem  1-2,  Appendix  A).  A  more 
general  type  of  discretization  than  that  used  by  wavefront  propagation  takes  place  when  terrain  features  are 
modelled  using  polygons.  Here,  error  in  model  optunal  paths  versus  real-world  optimal  paths  can  be  much 
less  than  with  rectangular  tesselations,  but  since  algorithms  which  use  this  type  of  discretization  have  com- 
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plexities  which  depend  on  the  number  of  terrain-feature  vertices  in  the  map,  there  is  a  trade-off  between  ac- 
curacy of  representation  and  speed  of  execution. 

Path-planning  methods  have  used  at  least  four  distinct  techniques  which  can  be  considered  spatial  reason- 
ing techniques,  with  many  algorithms  appealing  to  more  than  one  of  the  techniques.  They  are  visibility-graph 
methods,  the  Snell's  Law  local  optimization  criterion,  the  continuous-Dijkstra  paradigm,  and  methods  using 
optimal-path  maps. 

a.     Visibility  Graphs 

Visibility -Graph  methods  [Ref.  1  ]  solve  the  polygonal  obstacle-avoidance  shortest-path  problem 
(binary  terrain),  constructing  a  graph  where  each  of  the  n  obstacle  vertices  plus  the  start  and  goal  points  are 
nodes,  and  undirected  arcs  connect  nodes  whose  vertices  are  intervisible,  i.e.,  can  be  connected  by  a  line  seg- 
ment which  does  not  intersect  any  obstacle  edge.  Because  of  the  spatial  reasoning  principle  about  binary  ter- 
rain stated  above,  it  is  assured  that  every  segment  of  an  optimal  path  will  occur  in  the  visibiUty  graph,  so  to 
find  an  optimal  path  it  is  sufficient  to  search  the  graph  using  branch-and-  bound  search. 

Several  algorithms  have  been  given  to  construct  the  visibility  graph.  The  naive  algorithm  checks 
every  pair  of  vertices  against  every  edge  to  see  if  the  Une  segment  connecting  them  intersects  the  edge.  Since 
there  are  0(n  )  pairs  of  vertices  and  0(n)  edges,  this  brute  force  algorithm  has  worst-case  time  complexity 
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0(n  ).  Lee  [Ref.  31]  and  Mitchell  [Ref.  32]  explain  an  0(n  log  n)  algorithm  which  begins  by  constructing  for 
each  vertex  a  list  of  the  otlier  vertices  sorted  according  to  the  heading  of  the  line  between  them  in  0(n  log  n) 
time,  and  then  for  each  of  tlie  n  sorted  sets,  doing  an  angular  sweep  checking  for  intersection  against  the  closest 
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obstacle  edge.  Welz!  [Ref  33]  and  Asano  [Ref  34]  used  the  fact  that  n  sorts  can  be  done  in  0(n  )  time  to  build 
an  0(n  )  visibility  graph  construction  algoritlim.  Ghosh  and  Mount  [Ref.  35]  give  an  algorithm  to  compute 
the  visibiUty  graph  of  n  disjoint  line  segments  in  time  0(e  +  n  log  n),  where  e  is  the  number  of  edges  in  the 
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visibility  graph  (an  output-sensitive  complexity).  Since  e  may  be  as  small  as  n  or  as  large  as  n  ,  this  algorithm's 
worst-case  time  complexity  ranges  from  0(n  log  n)  to  0(n  )  depending  on  tlie  size  of  the  visibility  graph. 

Once  the  visibiUty  graph  has  been  constructed,  Dijkstra's  algorithm  or  the  special  case  of  it  called 
A*  (see  Section  A),  may  be  used  to  search  for  the  shortest  path  from  the  start  to  the  goal.  The  worst-case  time 
complexity  of  Dijkstra's  algorithm  is  given  by  Aho,  Hopcrofl,  and  Ullman  as  0(e  log  n)  [Ref.  36].  Again,  be- 
cause  of  tl)e  range  of  e,  tliis  means  thai  Dijkstra's  algorithm  is,  in  the  worst  ca.se,  ©(n"  log  n).  or  willi  a  .spar.se 
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visibility  graph,  0(n  log  n).  A*,  an  "informed"  version  of  Dijkstra's  algorithm,  has  time  complexity  of  the 
same  order  class  in  the  worst  case  [Ref.  15],  although  actual  implementations  should  show  a  significant  em- 
pirical  superiority  of  A*.  Thus,  the  shortest-path  problem  can  be  solved  by  a  visibility-graph  s^proacb  in  0(n 
log  n)  time. 

For  the  variation  of  the  weighted-region  problem  (or  generalization  of  the  shortest-path  problem) 
given  by  Rowe  [Ref.  2]  which  considers  roads  and  rivers  as  well  as  obstacles,  a  visibility-graph-influenced 
approach  is  used  to  transform  the  search  space  to  a  finite  one.  Reasoning  about  how  optimal  paths  must  be- 
have in  the  presence  of  roads  and  rivers  leads  to  the  conclusions  that  a  path  will  enter  or  leave  a  road  at  only 
one  critical  angle,  and  that  paths  either  cross  a  river  without  changing  heading,  or  go  around  river-end  vertices 
as  they  would  an  obstacle  vertex.  A  visibility  graph  is  constructed  using  as  nodes  all  obstacle  and  river  ver- 
tices and  start  and  goal  points;  roads  and  rivers  are  not  considered  to  obscure  visibility.  Additionally,  line  seg- 
ments from  each  node  arc  constructed  which  intersect  each  road  at  the  critical  angle.  If  the  points  are  otherwise 
visible,  the  road-intersection  point  is  added  as  a  node  and  the  graph  reflects  that  the  points  are  connected.  Fur- 
ther, all  nodes  which  Ue  on  contiguous  road  segments  are  connected.  This  graph  is  then  searched  using 
Dijkstra's  or  A*  algorithms  as  above.  Figure  8  shows  the  edges  of  an  example  generalized  visibility  graph.  In 
this  figure,  solid  lines  represent  roads,  dotted  hnes  represent  rivers,  and  filled  polygons  represent  obstacles. 
Narrow  dashed  lines  represent  V-graph  edges  and  the  thick  dashed  line  represents  the  optimal  path  fi^om  start 
to  goal  points.  Similar  results  for  Unear  features  are  reported  by  Gewah  et  al.  [Ref.  37] 
b.     SneU's  Law  Local  Optimality  Criterion 

Optimal  paths  in  the  weighled-regiou  domain  obey  an  analogy  to  SneU's  Law  of  Refraction  in 
optics  [Ref.  20],  [Ref.  3],  [Ref  38].  SneU's  Law  is  based  on  Fermat' s Principle  which  says  that  light  seeks  the 
path  of  minimum  time.  Fermat  s  Principle  has  an  analogy  in  the  weighted-region  problem,  since  time  is  a  cost 
proportional  to  distance  travelled  in  a  homogeneous-index  region.  Thus  optimal  paths  follow  Snell's  Law. 

SneU's  Law  for  Optimal  Paths:  An  optimal  path  passing  through  an  edge  between  two  regions 
with  cosls-per-unii-distance  ci  and  C2  obeys  the  relationship  ci  sin  0i  =  C2  sin  62,  where  Oi  and  62 
are  the  angles  of  incidence  and  refraction  respectively,  i.e.,  the  angle  from  the  path  in  the  first  region 
to  a  line  normal  to  the  edge,  aixl  the  angle  from  the  path  in  the  second  region  to  a  line  normal  to  the 
edge.  (See  Figure  9.) 
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Figure  8 
Visibility  Giapii  for  RRR  Algoritiun 
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cost  =  Ci 


Figure  9 
Snell's  Law  for  Optimal  Paths 
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Note  that  Snell's  Law  is  a  criterion  for  local,  not  global,  optimality ;  a  non-optimal  path  may  obey  Snell's  Law 
at  each  edge  crossing.  Therefore,  its  usefulness  is  in  constructing  candidates  for  global  optimality. 

The  analogy  to  Snell's  Law  applies  to  crossings  with  an  angle  of  iiKidence  and  refraction  soch 
that  01  and  82  are  both  less  than  or  equal  to  90*'.  In  the  path-planning  domain  optimal  paths  cannot  occur 
that  have  angles  of  incidence  greater  than  a  critical  angle  which  is  6c  =  sin"  Ci/cj,  where  q  <  Cj  and  Cj  is  the 
cost  of  the  region  on  the  incidence  side  of  the  edge.  For  example,  in  Figure  10  an  optimal  path  may  go  from 
point  S  to  any  point  to  the  left  of  point  A,  but  may  not  go  immediately  to  its  right,  because  the  angle  9  t  h  a  t 
line  AB  would  form  with  edge  PQ  of  the  high-cost  region  would  exceed  6c.  This  is  called  total  internal 
reflection,  in  optics.  Another  example  of  such  behavior  is  found  in  Figure  11,  where  a  path  SABG  follows 
Snell's  Law  making  an  angle  exactly  the  critical  angle  at  point  A  and  then  at  B. 

In  Figure  12,  paths  just  to  the  left  of  SV  will  be  refracted  according  to  Snell's  Law  as  is  path 
SVA,  while  paths  just  to  the  right  of  SV  will  be  refracted  as  is  path  SVB,  but  paths  which  go  through  point  V 
may  lie  anywhere  within  the  wedge  formed  by  AVB.  If  we  consider  that  the  edges  which  meet  at  point  V  are 
actually  continuously  curved  there,  SneU's  Law  will  apply  as  the  local  curvature  increases  to  infinity.  The 
same  behavior  happens  in  Figure  13,  at  vertex  V  of  an  obstacle. 

Finding  an  exact  Snell's-Law  path  between  two  points  through  a  sequence  of  edges  requires  an 
iterative  search.  Richbourg  [Ref.  20]  and  Mitchell  [Ref  15]  both  discuss  the  lack  of  a  closed-fonn  solution  for 
the  problem  of  finding  the  Snell's-Law  path  between  two  points.  But  since  it  is  an  easy  task  to  trace  a  Snell's- 
Law  path  from  a  point  with  a  given  heading,  both  conclude  that  an  iterative  search  is  the  best  approach.  Rich- 
bourg studies  the  effectiveness  of  four  techniques  for  finding,  to  within  a  given  error,  a  Snell  's-Law  path  across 
one  edge.  He  used  experiments  appUed  to  bisection  search,  golden-section  search,  false-position  search,  and 
a  modification  called  heuristic  false-position  search,  and  found  that  the  latter  converged  more  than  twice  as 
fast  as  any  of  the  others  on  the  average,  and  also  had  the  least  standard  deviation  of  the  four  methods.  His 
heuristic  false-position  method  attempts  to  avoid  the  situation  where  the  search  approaches  the  solution  from 
the  same  side  at  each  iteration,  since  false-position  tends  to  converge  more  quickly  when  the  solution  is  brack- 
eted. 

Mitchell 's  algorillun  uses  a  numerical  routine  to  approximate  the  SneU  's-Law  path  across  n  edges 
which  is  of  a  time  complexity  that  he  calculates  is  bounded  by  OlnX),  where  L  is  a  measure  of  the  precision 
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Figure  10 
Snell's  Law  Example  1 
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Figure  11 
Snell's  Law  Example  2 
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Figure  12 
Snell's  Law  Example  3 
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Figure  13 
Snell's  Law  Example  4 
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of  the  problem  instance.  Thds  routine  is  used  because  of  its  proven  worst-case  speed,  but  he  also  reports  a  coor- 
dinate descent  method  for  solving  a  Snell's-Law  path  across  several  edges  which  is  said  to  have  fast  empiri- 
cal convergence.  This  method  uses  as  a  starting  path  a  sequence  of  line  segments  between  start  and  goal  points 
through  the  midpoint  of  each  edge.  It  then  successively  adjusts  each  crossing  point  in  constant  time  to  satisfy 
Snell's  Law  with  respect  to  its  two  neighbor  crossing  points,  iteratively  applying  these  adjustments  until  the 
path  is  within  a  specified  error  of  the  goal. 

c.     Continoons-DUkstra  Paradigm 

Path-planning  methods  for  the  weighted-region  problem  have  used  one  of  two  similar  ap- 
proaches, both  relying  on  Snell's  Law  and  related  properties  as  discussed  above.  Mitchell's  algorithm  uses 
what  he  calls  the  continuous-Dijkstra  paradigm,  because  of  its  analogy  to  the  discrete  Dijkstra  algorithm  [Ref. 
3],  while  Richbourg's  algorithm  uses  recursive  wedge  decomposition  [Ref.  20],  [Ref.  21].  Whereas  Dijkstra's 
algorithm  must  be  used  over  terrain  approximated  by  map  discretization,  the  continuous-Dijkstra  and  the  recur- 
sive-wedge-decomposition paradigms  are  used  over  terrain  in  which  terrain  features  are  represented  by 
polygons  or  piecewise-linear  curves. 

The  continuous-Dijkstra  paradigm,  analogously  to  searching  a  finite  graph  for  the  next  closest 
node  in  Dijkstra's  algorithm,  searches  in  a  concentric  plane  sweep  outward  from  the  start  point,  processing 
each  terrain-feature  vertex  as  the  sweep  reaches  it.  The  algorithm  requires  tlie  triangulation  of  the  terrain  map, 
a  task  for  which  standard  algorithms  are  available  from  computational  geometry.  Each  vertex  has  associated 
with  it  a  label  which  represents  the  cost  of  the  best  path  yet  found  to  it,  just  as  in  the  discrete  Dijkstra  algo- 
rithm. Additional  points,  cdWtd  frontier  points,  also  have  labels  associated  with  them.  They  are  points  in  the 
interior  of  an  edge  at  which  critical  reflection  occurs  (see  above). 

The  key  data  structures  for  Mitchell's  algorithm  are  first,  a  list  of  subsegments  of  terrain- feature 
edges  called  candidate  intervals  of  optimality ,  and  second,  a  priority  queue  called  the  event  queue  after  the 
terminology  used  in  the  plane  sweep  paradigm.  Candidate  intervals  of  optimahty  are  the  extent  of  an  edge  over 
which  an  optimal  path  could  possibly  lie  by  the  constraints  of  Snell's  Law.  Intervals  include  information  about 
the  root,  or  last  previous  vertex  through  which  tlie  all  optimal  paths  which  cross  the  interval  lie,  and  about  the 
paths  from  this  root  to  either  end  of  the  subsegmenl  interval.  The  event  queue  contains  those  points  which  are 
end  points  of  some  candidate  interval,  or  are  frontier  points  in  the  interior  of  an  interval. 
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At  each  step  of  the  algorithm,  the  point  on  the  event  queue  with  the  smallest  cumulative  cost 
from  the  start  point  is  chosea  If  it  is  a  fiontier  point,  then  the  candidate  interval  is  said  io  propagate.  In  other 
words,  more  candidate  intervals  on  other  edges  are  found  each  of  which  includes  an  edge  subsegment  to  which 
optimal  paths  could  arrive  through  the  initial  interval.  The  appropriate  points  have  their  costs  computed  and 
are  added  to  the  event  queue.  When  the  event  queue  becomes  empty,  the  algorithm  terminates,  and  the  goal 
point  has  been  labelled  with  its  optimal  cost.  The  list  of  candidate  intervals  holds,  at  any  point  in  the  algorithm , 
the  best  path  or  set  of  paths  so  far  from  the  start  point  to  the  interval,  so  the  interval  which  is  the  goal  point  is 
fouixi  in  order  to  retrieve  the  optimal  path.  This  algorithm  has  at  most  0(n' )  event  points,  and  uses  the  O(n'x) 
routine  discussed  above  to  find  a  SneU's-Law  path  between  two  points,  and  so  has  a  worst-case  time  com- 
plexity of  0(n  L),  where  n  is  the  number  of  terrain-feature  vertices  and  L  is  a  measure  of  the  precision  of  the 
problem  instance. 

Richbourg's  algorithm  uses  A*  search  to  select  a  group  of  paths  for  refinement  which  offers  the 
best  hope  of  containing  the  optimal  path  from  the  start  point  to  the  goal  [Ref.  20J.  As  refined  Rowe  and  Rich- 
bourg  [Ref.  39],  a  well-befiaved  path  subspace  (WBPS)  is  defined  as  a  set  of  paths  which  cross  the  same  ter- 
rain- feature  edges  and  vertices  from  the  start  to  the  goal.  A  wedge  is  a  partial  WBPS  which  is  a  set  of  paths 
crossing  the  same  edges  and  vertices  from  the  start  point  to  some  intermediate  point  or  edge.  Refining  a  wedge 
means  finding  within  the  wedge  the  neatest  intermediate  point  which  has  not  yet  been  considered,  finding  a 
Snell's-Law  path  to  that  point,  and  splitting  the  wedge  into  three  sub-wedges  based  on  the  cases  which  arise 
from  Snell's  Law.  These  three  wedges  are  added  back  to  the  A*  agenda  for  further  consideration.  Two  of  the 
three  wedges  are  those  consisting  of  paths  which  pass  to  the  "left"  and  "right"  of  the  point  al  which  splitting 
occurs,  while  tlie  middle  wedge  is  constructed  based  on  the  possible  behavior  of  paths  emanating  from  the 
point.  The  tenn  recursive  wedge  decomposition  refers  to  the  successive  splitting  of  wedges  as  they  are  selected 
from  the  A*  agenda  and  refined. 

The  search  space  for  recursive  wedge  decomposition  is  a  known  feasible  start-to-goal  path  and 
a  set  of  wedges  with  associated  lower-bound  values  of  cost  function  plus  evaluation  function  for  each  wedge. 
These  lower-bound  values  represent  the  lowest  possible  cost  for  a  path  within  the  wedge.  The  known  feasible 
path  is  replaced  whenever  a  better  path  is  found,  so  that  it  is  always  tlie  best  known  palli.  The  single  operator 
for  state  transformation  is  wedge  refinement.  The  algorillini  uses  a  different  termination  criterion  than  that 
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normally  used  by  A*  in  path-planning  applications.  Normally  the  search  can  stop  when  the  first  element  on 
the  agenda  is  a  complete  solution,  because  the  agenda  is  ordered  by  increasing  cost-function  plus  evaluation- 
function  values,  and  for  a  complete  path  the  evaluation  function  equals  zero  and  the  cost  function  is  the  ac- 
tual cost  from  start  to  goal.  However,  in  this  search  space,  the  elements  on  the  agenda  are  wedges,  not  paths. 
The  search  terminates  when  the  best  wedge  on  the  agenda  (and  hence  all  other  wedges  on  the  agenda  as  well) 
has  a  cost-function  plus  evaluation- function  value  that  exceeds  the  upper-bound  cost  of  the  current  best  feasible 
known  path,  or  when  the  agetxla  is  empty.  In  either  case  the  least-cost  known  path  is  the  solution.  Wedges  are 
pruned,  or  removed  from  the  search  space,  according  to  a  set  of  criteria  based  on  Snell's  Law  and  other  spa- 
tial reasoning.  An  implementation  of  Richbourg's  recursive- wedge-decomposition  algorithm  is  reported  to 
have  empirical  performance  which  strongly  suggests  an  0(n  )  average-case  time  complexity,  where  n  is  the 
number  of  terrain-feature  vertices.  Worst-case  time  complexity  was  reported  to  be  0(n!n  )  [Ref.  39]. 

The  two  algorithms  are  quite  similar  in  some  respeas.  The  candidate  interval  of  the  continuous- 
Dijkstra  algoritlim  along  with  its  associated  data  about  boundary  paths  corresponds  to  the  wedges  of  the  recur- 
sive-wedge-decomposition algorithm,  and  propagation  of  intervals  corresponds  to  refinement  of  wedges.  The 
same  properties  of  Snell's  Law  refraction  and  critical  reflection  are  used  in  determining  how  to  refine  wedges 
(propagate  intervals).  However,  there  are  differences  of  emphasis.  The  focus  of  the  continuous-Dijkstra  algo- 
rithm seems  to  be  finding  a  polynomial-time  worst-case  algorithm,  while  the  A*  search  of  the  recursive- wedge- 
decomposition  algorithm  focuses  on  average-case  performance.  The  continuous-Dijkstra  algorithm  requires 
a  triangulalion  of  the  input  map,  a  time-consuming  preprocessing  step  which  nevertheless  does  not  raise  the 
worst-case  time  order  of  complexity,  while  the  recursive-wedge-decomposition  algorithm  takes  as  input  a  map 
of  polygonal  terrain  features.  The  recursive-wedge-decomposition  implementation  reported  in  [Ref.  21]  was 
used  in  our  research  for  initialization  in  our  Chapter  VI  algorithms. 

A  generalization  of  the  weighted-region  problem  allows  anisotropic  costs  in  regions,  that  is,  costs 
which  are  a  function  of  the  direction  of  travel  of  the  mobile  agent,  for  example,  in  steeply  sloped  terrain.  Ross 
[Ref.  40]  solves  the  anisotropic  weighted-region  problem  using  a  variation  of  recursive- wedge  decomposition. 
Based  on  the  effects  of  gravity,  friction,  and  maximum  force  which  can  be  apphed  by  the  agent,  there  are 
several  sets  of  impermissible  headings  which  may  constrain  travel  across  a  polygonal  region.  A  range  of  uphill 
headings  may  be  ruled  out  by  maximum  force  available,  loss  of  traction,  or  catastrophic  overturn,  and  a  range 
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of  sideslope  headings  may  be  ruled  out  by  catastrophic  overturn  considerations.  Additional  optimality  con- 
siderations include  a  range  of  downhill  braking  headings  within  which  the  agent  must  lose  energy  by  braking, 
arxi  Snell  's  Law  for  optimal  paths  as  described  above.  Given  these  c(Xistraints,  there  are  only  four  ways  an  op- 
timal path  can  cross  an  anisotropic  region.  This  insight  leads  to  an  algorithm  which  recursively  decomposes 
groups  of  potentially  optimal  paths  according  to  which  terrain-feature  vertices  and  edges  they  cross  {window 
sequences),  and  applies  A*  search  to  these  groups  of  paths,  using  various  pruning  criteria  to  limit  the  search 
space. 

d.    Optimal-Path  Maps 

Several  researchers  have  used  optimal-path  maps  (0PM),  or  as  they  are  commonly  called  with 
respect  to  binary  terrain,  shortest-path  maps,  as  a  means  of  solving  the  shortest-path,  binary-terrain  problem. 
Lee  and  Preparata  [Ref.  41]  give  an  0(n  log  n)  algorithm  to  construct  an  0PM  for  the  special  case  that  all 
obstacles  are  parallel  line  segments,  and  Reif  and  Storer  [Ref.  42]  give  an  0(mn  +  n  log  n)  algorithm,  where 
m  is  the  number  of  obstacles  and  n  is  the  number  of  obstacle  vertices.  Mitchell  [Ref.  4]  gives  an  0(kn  log  n) 
algorithm  for  the  general  case,  where  k  is  an  output-sensitive  parameter  somewhat  related  to  the  density  of 
obstacles  in  the  plane. 

Tlie  algorithm  of  Lee  and  Preparata  uses  the  plane  sweep  paradigm  and  constructs  both  the  op- 
timal-path tree  and  the  planar  partition  with  one  sweep  of  the  plane.  Assuming  without  loss  of  generality  that 
the  parallel  Une-segment  obstacles  are  vertical  and  the  start  point  is  to  the  left  of  all  obstacles,  the  sweep  line 
is  also  vertical  and  begins  at  the  start  point.  The  obstacles  are  indexed  by  their  x-coordinates,  and  the  initial 
event  queue  contains  the  x-coordinates  of  each  obstacle.  As  the  sweep  line  encounters  an  obstacle,  it  locates 
the  two  endpoints  in  regions  of  the  0PM  so  far  constructed  and  extends  the  optimal-path  tree  by  inserting  a 
node  for  each  obstacle  endpoint  into  the  tree  at  the  node  associated  with  these  regioas.  Then  it  constructs  the 
three  bisectors,  or  homogeneous-behavior  region  boundaries,  which  begin  at  the  obstacle,  two  of  which  are 
rays  and  one  of  which  is  a  hyperbola  segment.  It  updates  a  list  of  "active"  bisectors  by  deleting  previously- 
found  bisectors  which  intersect  the  current  obstacle,  and  adds  the  new  bisectors  to  the  list.  Then  it  updates  the 
event  queue  by  inserting  points  of  intersection  of  t!ie  new  bisectors  with  any  otlier  bisectors.  Only  the  left- 
niost  such  intersection  must  be  recorded.  At  each  stage,  the  0PM  is  updated  when  both  endpoints  of  a  bisec- 
tor are  found.  fRcf.  41] 
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The  algorithm  due  to  Reif  and  Storer  takes  as  input  a  tiiangulation  of  the  obstacle  edges,  and 
recursively  processes  these  triangles  to  find  shortest  paths  from  the  start  point  to  each  vertex  of  the  triangula- 
lion.  The  algorithm  "grows"  outward  from  the  start  point,  constructing  a  partition  of  the  plane.  The  discussion 
of  this  algorithm  in  Reference  42  is  somewhat  obscure,  as  it  does  not  use  the  terminology  of  shortest-path 
maps,  and  depends  on  other  algorithms  and  data  structures  not  fully  explained  in  Reference  42. 

A  solution  to  the  optimal-path-map  problem  which  takes  a  different  approach  is  presented  by 
Payton  [Ref.  43].  It  is  built  on  the  wavefront  propagation  algorithm,  and  consists  of  storing  the  back-pointers 
for  each  cell.  This  array  of  pointers  is  called  a  gradient  field,  and  provides  information  about  which  direction 
a  mobile  agent  should  go  from  any  point  on  the  map  in  order  to  travel  along  an  optimal  path.  This  approach 
could  be  used  with  other  point-to-point  patli  planners  as  well,  although  with  greatly  increased  preprocessing 
time,  by  simply  running  the  path  planner  for  a  finely-grained  array  of  start  points,  and  storing  the  initial  direc- 
tion of  the  resulting  optimal  path  for  each  run. 

Mitchell's  algorithm  introduces  the  concept  of  "generalized  visibility"  within  the  obstacle  space, 
and  constructs  shortest-path  maps  for  each  new  level  of  visibility.  This  algorithm  begins  by  computing  the 
visibihty  polygon  from  the  start  point,  i.e.,  the  polygon  containing  all  points  in  the  map  which  are  not  occluded 
from  the  start  point  by  an  obstacle  edge.  Then  it  appeals  to  the  algorithm  for  constructing  generalized  Voronoi 
diagrams  within  simple  polygons  due  to  Aronov  [Ref.  13]  which  takes  into  account  that  boundaries  may  be 
hyperbolic  or  linear,  depending  on  the  costs  of  optimal  paths  from  obstacle  vertices.  Using  this  generalized- 
Voronoi-diagram  concept,  Mitchell's  approach  constructs  a  shortest-path  map  for  the  visibility  polygon.  Then, 
the  algorithm  computes  the  second  level  of  visibility,  that  is,  extends  the  visibility  j)olygon  to  include  all  points 
visible  from  any  part  of  the  initial  visibility  polygon.  Again,  it  reduces  the  problem  of  extending  the  shortest- 
path  map  to  llie  problem  of  defining  appropriate  Voronoi-diagram  problems  on  simple  polygons.  This  process 
continues  iteratively  until  all  obstacles  have  been  found  by  the  generalized  visibUity  process.  [Ref.  4] 

So  essentially,  Mitchell's  algorithm  is  doing  a  concentric  plane  sweep  (although  not  using  this 
terminology),  where  at  each  iteration,  the  next  generalized  visibility  polygon  is  found,  a  Voronoi  diagram  is 
constructed  for  the  obstacles  in  the  polygon,  and  these  Voronoi  diagrams  are  merged  with  the  Voronoi  diagram 
from  the  previous  iterations.  The  computation  of  visibUity  polygons  does  use  the  plane  sweep  paradigm  ex- 
plicitly, sweeping  a  "geodesic"  (or  optimal)  path  angularly  about  the  start  point.  In  order  to  deal  with  several 
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cases  in  which  a  single  sweep  would  not  correclly  identify  all  the  event  points,  two  sweeps,  one  in  each  direc- 
tion  about  the  start  point,  are  done  to  compute  each  visibility  polygon.  This  algorithm  operates  in  0(n  log  n) 
worst-case  time,  where  n  is  the  number  of  obstacle  vertices  in  the  input  map.  [Ref.  4] 

The  focus  of  this  dissertation  is  on  the  construction  of  a  planar  partition  for  the  weighted-region 
problem.  In  keeping  with  the  convention  discussed  above  of  referring  to  solutions  to  the  weighted-region 
problem  as  optimal  paths  instead  of  shortest  paths,  we  refer  to  such  a  partition  as  an  optimal-path  map.  Mitchell 
[Ref.  15],  claims  to  have  constructed  an  optimal-path  map  for  the  weighted-region  problem,  but  does  not  men- 
tion the  task  of  constructing  region  boundaries.  His  algorithm  appears  to  construct,  instead,  an  optimal-path 
tree,  a  necessary  and  time-consuming  first  step  in  constructing  an  optimal-path  map,  but  gives  little  attention 
to  construction  of  the  planar  partition.  This  confusion  may  arise  bom  the  fact  that  in  the  binary-terrain  domain, 
construction  of  region  boundaries  is  straightforward,  a  fairly  insignificant  part  of  the  total  problem,  while  the 
added  complejuty  of  the  weighted-region  problem  creates  additional  complexities  in  the  characterization  of 
boundaries  and  the  construction  of  the  optimal-path  map.  In  binary  terrain,  the  standard  Voronoi-diagram 
methods  which  construct  straight-line  bisectors  only  need  to  be  extended  to  construct  hyperbola  segments  as 
well,  while  in  weighted-region  terrain,  such  bisectors  take  on  many  different  forms.  Thus  the  problem  of  "defin- 
ing the  appropriate  Voronoi-diagram  problem",  as  Mitchell  does  in  the  binary  case,  is  a  much  more  difficult 
one. 
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ni.  MODIFYING  WAVEFRONT  PROPAGATION  TO  FIND  SUB-OPTIMAL 
SOLUTIONS  TO  THE  OPTIMAL-PATH-MAP  PROBLEM 

A.    OVERVIEW 

Wavefront  propagation  is  well-suited  as  a  method  for  solving  the  fixed-goal  optimal-path-map  problem 
(see  Chapter  II,  Section  C  for  a  complete  description  of  this  problem),  if  the  inherent  error  is  acceptable  in  the 
application  domain.  The  basic  wavefront  propagation  algorithm  can  easily  be  extended  by  considering,  for 
each  ceU  on  the  wavefront,  whether  there  should  be  a  boundary  between  it  aixl  its  adjacent  cells,  using  one  of 
the  three  definitions  of  "similar  behavior".  What  for  the  point-to-point  problem  was  a  disadvantage  of 
wavefront  propagation,  that  the  algorithm  in  its  basic  form  searched  bUndly  in  all  directions  without  regard  to 
the  location  of  the  goal,  becomes  an  advantage  for  the  optimal-path-map  problem  because  the  paths  from  each 
cell  in  the  map  are  available  as  a  by-product  of  the  algorithm  simply  by  tracing  the  back  pointers.  Another  ad- 
vantage is  that  the  asymptotic  worst-case  time  complexity  of  the  extension  is  the  same  as  the  basic  algorithm. 

In  chapter  II  the  path-generalizing  function  was  defined  in  terms  of  "similar  behavior"  of  paths.  In  this 
chapter  we  solidify  the  meaning  of  "similar  behavior"  to  group  paths  in  three  different  ways  that  make  sense 
for  wavefront  propagation,  thus  defining  the  path-generalizing  function  in  three  ways.  The  first  way  produces 
boundaries  between  adjacent  cells  whose  goal  paths  turn  at  cells  which  are  not  "equivalent".  The  second  way 
uses  a  set  of  heuristics  to  group  cells  whose  goal  paths  converge.  The  third  way  groups  cells  according  to 
whether  their  paths  turn  at  the  same  terrain-feature  vertices  and  edges. 

It  might  be  possible  to  bypass  the  need  for  an  optimal-padi  map  altogether  by  simply  storing  back  pointers 
for  every  cell  in  the  map  (for  example,  in  the  work  of  Payton  discussed  in  Chapter  II  [Ref.  43],  such  a  database 
of  pointers  is  called  a  gradientfield).  Given  a  start  cell 's  coordinates,  the  path  to  the  goal  could  be  reconstructed 
by  following  the  pointers  back  to  the  goal  cell.  There  are  two  disadvantages  to  this  method.  First,  the  average- 
case  time  complexity  to  reconstruct  a  backpath  is  0(n),  for  an  input  map  of  size  n  by  n.  Second,  the  storage 
requirement  for  the  optimal-path  map  is  0(n   ).  To  avoid  these  problems,  we  store  an  optimal-path  map. 
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B.    MODIFYING  THE  PATH-GENERALIZING  FUNCTION  FOR  WAVEFRONT 
PROPAGATION  OPTIMAL-PATH-MAP  CONSTRUCTION 

1.     The  Pure  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 

The  most  natural  description  of  a  path  is  the  list  of  all  cells  from  start  point  to  goal  point.  Requiring 
two  such  path  lists  to  be  idendcal  in  order  to  represent  "similar  behavior"  would  result  in  every  cell  in  the  map 
comprising  its  own  homogeneous-behavior  region.  But  it  is  unnecessary  to  include  all  cells  in  a  path  segment 
which  lie  in  on  the  same  straight  line.  So  another  definition  of  a  path  list  is  the  list  of  cells  at  which  the  op- 
timal patli  turns,  or  more  precisely,  the  cells  in  the  backpatli  of  a  start  point  for  which  each  back-pointer  of  the 
cell  is  in  a  different  direction  llian  the  back-pointer  of  the  cell's  parent. 

This  definition  still  induces  many  distinct  regions.  A  modification  is  to  specify  that  two  turn-point 
cells  on  different  backpaths  are  considered  equivalent  if  one  of  them  lies  on  the  first  leg  of  the  optimal-path 
list  which  starts  at  the  other  turn-point.  Thus,  for  example,  the  two  cells  (5,3)  and  (6,2)  in  Figure  7  would  have 
optimal-path  lists  [(5,5),(7,7)]  and  [(6,6),(7,7)]  respectively;  cells  (5,5)  and  (6,6)  would  be  considered 
equivalent  because  the  optimal-path  list  of  cell  (5,5)  is  [(7,7)]  and  (6,6)  lies  on  the  line  between  (5,5)  and  (7,7); 
so  cells  (5,3)  and  (6,2)  be  in  the  same  region. 

We  call  the  version  of  the  wavefront  propagation  optimal-path-map  algorithm  which  uses  this  defini- 
tion of  the  path-generalizing  function  \i\epure  version,  since  it  is  based  on  a  simple  definition  of  homogeneous- 
behavior  regions.  Changes  to  the  basic  wavefront  propagation  algorithm  in  Appendix  B  necessary  to  implement 
this  are  presented  in  Table  1  below  (two  pages).  The  key  change  is  a  check  for  boundaries  between  each  cell 
on  the  wavefront  and  its  four  neighbors.  This  is  accomplished  in  procedure  expand-ceU  wliich  is  executed 
once  for  each  cell  on  the  current  wavefront.  Procedure  expand-ceU  calls  procedure  check-for-boundaries 
which  compares  the  path  h.sls  of  each  of  tlie  cell's  neighbors  with  tlie  expanding  cell's  path  list,  checking  for 
"equivalency"  as  defined  above.  Whenever  a  new  cell  is  added  to  the  wavefront,  its  path  list  is  set  by  proce- 
dure set-optimal-path-list  which  is  called  from  williin  orthogonal-expand,  diagonal-expand,  and  overflow. 
These  procedures,  altliough  not  shown  here,  are  nuxiified  from  the  versions  shown  m  Appendix  B  by  adding 
a  call  to  .set-optimal-path-list  after  each  new  cell  is  added  to  the  wavefront  list  or  the  overflow  list.  Wlien  the 
procedure  check-equivalent-paths  called  by  check-for-boundaries  dciennines  that  (wo  path  lists  arc  not 


51 


TABLE  1 
WAVEFRONT-PROPAGATION  OPM  ALGORITHM 


algorithm  wavefront-propagation-opm 
input:  Goal-Point 

{ 

Wavefront  :=  Goal-Point; 
Boundary-List  :=  empty  list; 
while  (Wavefront  not  empty) 
expand-wavefTont(Wavefront); 


(Algorithm  ini) 

/*  REVISED  from  algorithm  B-1  */ 
/*  in  Appendix  B.  */ 


/*  Iteratively  expand  wavefront  */ 

/*  until  nothing  remaias  on  it.  */ 

/*  end  of  wavefront-propagation-opm  */. 


procedure  expand-wavefront 
input:  Wavefront 

( 

if  (Wavefront  is  empty) 

I 

Cells-for-New-Wavefront  :=  empty  list; 

New-Wavefront  :=  empty  list; 


else 
I 


/*  REVISED  PROCEDURE  */ 


/*  Base  case  of  the  recursion.  */ 


Current-Cell  :=  cell  on  Wavefront  with  niin  remaining  cost; 
expand  -cell(  Current-Cell); 
Resl-of- Wavefront  :=  Wavefront  less  Current-Cell; 
expand-wavefront(Rest-of- Wavefront); 

New-Wavefronl  :=  Cells-for-New-Wavefronl 
appended  onto  front  of  New-Wavefront; 


) 


/*  recursive  call  to  expand-wavefront  */ 
/*  Note:  Wavefront  is  recursively  emptied  */ 
/*  out  level  by  level  and  New-Wavefront  */ 
/*  is  built  up  as  each  level  returns.  */ 
/*  end  of  expand-wavefront  */ 


/♦  REVISED  PROCEDURE  */ 


/*  initialize  flag  assuming  that  Current-Cell  */ 
/*  will  not  stay  on  Wavefront  */ 
/*  ADDED  TO  THIS  VERSION  */ 
/*  ADDED  TO  THIS  VERSION  */ 


procedure  expand-cell 
input:  Current  Cell 

{ 

Fini.shed-Wilh-Cell  :=TRUE; 

check-for-boundaries(Current-Cell); 

Boundary-List  :=  New-Boundary-List  appended 

to  Boundary-List; 
Cells-for-New-Wavefront  :=  empty  list; 
for  (New-Cell  :=  North-,  East-,  South-,  and  West-Neighbor) 

orthogonaI-expand(Current-Cell,New-Cen); 
for  (New-Cell  :=  Northeast-,  Southeast-,  Southwest-,  and  Northwest-Neighbor) 

diagonal-expand(Current-Cell, New-Cell); 
if  nut  (Finished-With-Cell)  /*  keep  Current-Cell  on  Wavefront  */ 

Cells-for-New-Wavefront  :=  Current-Cell  appended 

onto  Cells-for-New-Wavefront;  /*  CHECK  FOR  GOAL  DELETED  */ 


) 


/*  end  of  expand-ceU  */ 
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TABLE  1  (CONTINUED) 
WAVEFRONT-PROPAGATION  OPM  ALGORITHM 


procedure  check-for-buundaries 
input:  CurrcDt-Cell 

I 

New-Boundary-List  :=  empty  list; 

for  (Neighbor-Cell  :=  each  of 

Current-Cell's  eight  neighbors) 

if  not  (Parent-Pointer  of  Neighbor-Cell  =  nil) 


/*  NEW  PROCEDURE  */ 


} 


/*  if  wavefront  has  reached  neighbor,  */ 
/*  a  boundary  check  can  be  made.  */ 


OPLl  :=  OPL-Parent  of  Neighbor-Cell; 
0PL2  :=  OPL-Parent  of  Current-Cell; 

if  not  (check-equivaIent-paths(OPLl,OPL2))    /♦  update  new  boundary  list  */ 
New-Boundar>'-List  :=  edge  or  corner 

connecting  the  two  cells  appended  to  New -Boundary -List; 

} 

/*  end  of  check-for-boundaries  */ 


procedure  set-optimal-path-list 

input:  Cell 

I 

if  (Parent  of  Cell  is  on  line  segment  between 
Cell  and  OPL-Parent  of  Parent  of  Cell) 
OPL-Parent  of  Cell  :=  OPL-Parent 
of  Parent  of  Cell; 

else 

OPL-Parent  of  CeU  :=  Parent  of  Cell; 


/*  NEW  PROCEDURE  */ 

/*  NOTE:  There  are  two  parent-pointer  fields  in  */ 
/*  the  "CeU"  array  -  "Parent"  field  is  predecessor  */ 
/*  of  Cell  on  the  backpath:  "OPL-Parent"  is  the  */ 
/*  predecessor  on  tlie  Optimal-Path  List.  */ 


/*  end  of  optinial-path-Ust  */ 


procedure  check-equivalent-paths 

input:  OPLl,  the  OPL-Parent  of  Neiglibor-Cell 
and  0PL2,  the  OPL-Parent  of  Current-Cell 

output:  returns  TRUE  if  pallis  are 
equivalent,  FALSE  otherwise. 

{ 

if  ((first  cell  of  OPLl  =  first  cell  of  0PL2) 
or  (first  cell  of  OPLl  is  on  the  line 

between  first  and  second  cells  of  OPL2) 
or  (first  cell  of  OPL2  is  on  the  line 

between  first  and  second  cells  of  OPLl) 
relum(TRUE); 
else  return  (FALSE): 
} 


/*  NEW  PROCEDURE  */ 


/*  Patlis  are  equivalent  if  first  */ 
/*  pair  of  cells  are  equivalent  */ 


/*  end  of  check-equivalent-paths  */ 
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equivalent  according  to  the  above  definition,  the  edge  wlvich  the  two  cells  share  is  considered  a  boundary  and 
is  added  to  a  list  of  boundiuies. 

Since  each  cell  with  non-infinite  cost  is  on  the  wavefront  once  during  the  algorithm,  we  will  in  the 
end  check  each  cell  on  the  map.  For  two  adjacent  cells,  if  one  cell  is  has  been  reached  by  the  wavefront  and 
the  other  has  not  yet  been  reached,  the  second  cell's  path  list  will  not  yet  be  determined,  so  a  boundary  check 
is  not  yet  possible.  But  when  the  second  cell  is  finally  put  on  the  wavefront,  its  path  list  is  set  and  a  check  of 
its  neighbors  will  consider  the  first  cell.  So  it  is  guaranteed  that  all  pairs  of  neighbors  will  be  checked  by  the 
end  of  the  algorithm,  and  all  boundaries  between  cells  will  be  detected. 

Note  that  references  to  the  start  point  have  been  deleted  from  the  algorithm,  since  we  are  looking  for 
paths  to  all  start  points.  The  initial  center  of  the  wavefront  is  called  the  goal  point.  Also,  there  is  no  possibility 
for  the  algorithm  to  fail  because  of  an  inability  to  find  the  start  point.  When  no  cells  remain  on  the  wavefi"ont, 
tlie  program  is  done.  Then  the  list  of  boundaries  will  be  transformed  into  tlie  appropriate  data  structure,  a  doub- 
ly-connected edge  list,  and  the  path  infonnation  will  be  transformed  into  an  optimal-path  tree. 

The  procedure  set-optimal-path-Ust  will  be  called  by  procedures  orthogonal-expand,  diagonal-ex- 
pand, and  overflow  each  time  a  new  cell  is  appended  onto  the  Cells-for-New-Wavefi'ont  or  Overflow  lists 
respectively. 

Figure  14  (on  two  pages)  shows  tlie  result  of  applying  the  pure  definition  of  the  padi-generalizing 
function  to  wavefront  propagation,  with  a  map  consisting  of  a  single  obstacle  and  a  single  high-cost  area.  The 
figure  shows  successive  snapshots  over  time  as  tlie  wavefront  expands  and  the  back-pointers  are  set.  The 
wavefront  expands  from  the  goal  point  in  the  center,  and  back  pointers  show  the  optimal  path  from  each  start 
point  to  the  goal  point.  Homogeneous-behavior  boundaries  are  shown  as  dotted  curves.  (Several  horizontal 
backpaths  appear  darker  than  the  others  only  because  of  llie  resolution  of  the  printer  used.)  Figure  14a  shows 
the  fijst  tlu^ee  snapshots,  and  Figure  14b  shows  tlie  fourth  snapshot  and  a  final  fiame  with  backpaths  removed 
for  clarity. 

Several  homogeneous-behavior  boundaries  in  Figure  14  are  spurious,  that  is,  are  not  predicted  by 
theoretical  analysis.  (This  analysis  is  presented  in  Chapter  V.)  Near  the  upper  left  comer  of  the  high-cost  area, 
for  example,  (see  Frame  5  in  Figure  14b)  three  sLraighl  homogeneous-behavior  boundaries  emanate  from  a 
point  on  the  edge  of  the  high-cost  area:  one  is  vertical,  one  is  at  a  45°  angle,  and  one  is  horizontal.  The  latter 
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Figure  14b 
Example  of  Pure  0PM  Version  of  Wavefront  Propagation 
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two  of  these  boundaries  do  not  have  analogues  in  Uie  theoretical  case,  and  the  first,  analogous  to  the  "shadow" 
boundar>'  expected  at  that  vertex,  is  offset  from  the  vertex  of  the  high-cost  area  does  not  appear. 

Some  spurious  boundaries  are  generated  because  straight  lines  are  being  approximated  by  piecewise- 
linear  curves  in  the  eight  allowable  propagation  directions.  Several  examples  occur  to  the  right  of  the  high- 
cost  area  and  to  the  left  of  the  obstacle.  Multiple  parallel  boundaries  are  generated  by  the  upper-left  edge  of 
the  obstacle,  although  all  but  the  topmost  boundary  are  spurious,  while  the  two  lower  boundaries  generated 
by  the  lower-left  edge  are  both  predicted  by  the  analysis  of  Chapter  V.  The  reason  for  the  difference  is  that 
the  lower-left  edge  is  positioned  at  a  45°  angle  to  the  vertical,  allowing  a  single  straight  path  to  lie  along  it. 
Thus  the  above  boundary-detection  heuristic  does  not  detect  spurious  boundaries  along  the  edge  because  there 
are  no  turn  points  on  the  path.  But  the  upper-left  edge  lies  at  less  than  a  45°  angle  with  the  horizontal,  and  so 
the  path  along  it  must  "stair-step"  its  way  to  the  upper  vertex,  causing  boundaries  to  be  generated.  A  similar 
error  occurs  along  the  upper  right  and  lower  right  edges  of  the  high-cost  area,  where  the  stair-step  nature  of 
the  edges  causes  spurious  exterior  boundiuies  to  appear.  Further  spurious  boundaries  occur  in  the  inside  of  the 
high-cost  area,  and  outside  it  just  above  its  rightmost  vertex. 

Optimal-path  maps  generated  by  the  pure  wavefront  propagation  0PM  algorithm  wUl  be  useful  if 
these  spurious  homogeneous-behavior  boundaries  do  not  matter.  But  there  are  approximately  twice  as  many 
boundaries  as  are  predicted  by  theoretical  analysis,  so  storage  and  run-time  speed  are  correspondingly  less  ef- 
ficient. 

2.     The  Diverging-Path  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 

Another  approach  is  based  on  the  idea  that  two  adjacent  cells  whose  paths  diverge  should  be  in  dif- 
ferent regions,  and  so  a  boundary-  must  exist  between  them.  A  way  of  delecting  divergence  of  paths  is  to  check 
the  distance  between  the  7)th-generalion  ancestors  of  two  adjacent  cells.  If  the  ancestors  more  than  one  cell 
apart,  the  cells  are  defined  as  diverging  paths.  In  other  words,  we  define  the  path-generalizing  function  so  tliat 
it  maps  cells  to  sets  of  paths  which  do  not  diverge. 

What  should  the  value  of  n  be?  In  other  words,  how  far  back  along  the  paths  of  the  two  cells  being 
compared  should  we  check?  If  n  is  small,  there  will  be  fewer  cliecks  to  perform,  enhancing  efficiency.  If  n  is 
large  some  sriuill  Icrriiin  features  may  be  overiooked  by  the  divergence  mle  On  the  other  iiand  if  ii  is  huge. 
we  can  handle  situations,  such  a.s  boundar)'  emanating  from  the  obstacle  in  Figure  14b.  Frame  5,  where  back- 
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paths  may  parallel  each  other  for  some  distance  before  diverging.  But  this  situation  can  be  taken  care  of  by 
adding  a  second  condition  which  says  tliat  two  cells  are  in  different  regions  if  their  parents  are  in  different 
regions.  Even  with  this  rule,  however,  if  n=  1,  there  are  situations  where  the  parents  of  two  cells  with  diverg- 
ing paths  are  adjacent;  choosing  n  =  2  seems  to  give  the  best  results.  An  additional  necessary  heuristic  is  tliat 
two  paths  are  in  different  regions  if  a  cell  between  tl)e  two  ancestors  being  checked  is  a  terrain  feature  cell. 
This  handles  special  cases  such  as  very  acute  obstacle  vertices,  or  paths  on  opposite  sides  of  a  river.  Figure  15 
(on  two  pages)  shows  the  result  of  applying  these  heuristics  to  wavefront  propagation.  We  call  this  the  diverg- 
ing-path  version  of  die  wavefront-propagation  0PM- generation  algorithm. 

So  there  are  three  heuristics  used  in  tlie  diverging-path  version.  First,  adjacent  cells  whose  second- 
generation  ancestors  are  more  than  one  cell  apart  are  in  different  regions.  Second,  adjacent  cells  are  in  dif- 
ferent regions  if  their  parents  are  in  different  regions.  Third,  cells  are  in  different  regions  if  their 
.second-generation  ancestors  have  a  terrain- feature  cell  between  them. 

Tliis  variant  algorithm  is  not  much  better  than  the  pure  variant,  as  can  be  seen  by  studying  Figure 
15b,  Frame  5.  Here  too  few  boundaries  are  generated,  and  a  few  spurious  boundaries  appear  as  well.  Those 
boundaries  defined  in  Chapter  V  as  opposite-edge  boundaries,  i.e.,  boundaries  which  distinguish  between 
paths  which  go  in  opposite  directions  around  a  terrain  feature,  are  the  ones  best  detected  by  the  diverging-path 
version.  Shadow  boundaries,  i.e.,  boundaries  which  distinguish  between  paths  which  go  through  a  terrain-fea- 
ture vertex  from  those  wliich  bypass  it,  are  not  detected  at  all.  Spurious  boundaries  arise  within  homogeneous- 
cost  areas.  The  homogeneous-cost  area  in  Figure  15  has  spurious  boundaries  just  above  its  rightmost  vertex. 
But  for  purely  biniuy  terrain,  i.e.,  obstacles  on  a  homogeneous-cost  background,  the  diverging-patli  version 
may  be  appropriate. 

3.     The  Vertex-Edge  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 

Any  variant  algorithm  that  relies  solely  on  the  turns  in  a  path  will  misinterpret  some  turns  as  due  to 
the  terrain  when  in  fact  they  were  due  only  to  the  mechanics  of  the  algoritlim  (e.g.,  the  eight  propagation  direc- 
tions), and  vice  versa.  Also,  Uie  diverging-palh  variant  only  detects  a  certain  class  of  boundary.  A  way  to  at- 
tack both  of  these  problems  is  to  plot  boundiuies  based  on  how  terrain-features  affect  optimal  paths. 

In  terrain  with  piecewise-linear  edges  in  homogeneous-cost  background,  optimal  pallis  will  turn  only 
at  terrain  feature  vertices  or  edges  (Theorem  1-2,  Appendix  A).  Tlius,  if  a  luni  in  a  path  occurs  at  other  than  a 
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vertex  or  edge,  it  must  be  turning  based  on  algorithm  mechanics  alone.  So  we  could  check  whether  or  not  a 
turn  point  in  a  path  is  adjacent  to  a  terrain-feature  vertex  or  occurs  at  the  edge  of  a  homogeneous-cost  region. 
We  could  define  the  path-generalizing  function  as  mapping  a  cell  to  a  list  of  the  terrain-feature  vertices  and 
edges  at  which  its  optimal  path  turns.  We  can  say  that  a  path  turns  at  a  vertex  or  edge  if  the  turn  cell  is  ad- 
jacent to  or  the  same  as  the  vertex  or  edge  cell. 

This  approach  requires  some  additional  terrain  preprocessing.  Since  terrain  in  the  two  previous  ver- 
sions has  been  represented  entirely  as  individual  cells,  some  way  of  finding  and  representing  terrain- feature 
edges  and  vertices  will  become  necessary.  Such  a  preprocessing  algorithm  could  group  cells  into  terrain  fea- 
tures of  homogeneous  cost,  and  then  fit  polygons  to  each  feature.  For  each  vertex  of  the  polygon,  it  could  find 
the  closest  corresponding  cell  in  the  original  representation  and  label  it  as  a  vertex.  For  each  edge  of  the 
polygon,  it  could  find  which  cells  most  closely  corresponded  to  it  and  label  them  as  lying  on  that  edge.  Wade 
[Ref.  44]  presents  an  algorithm  for  doing  such  terrain  preprocessing. 

So  we  redefine  "path  Ust"  to  include  only  vertex  and  edge  descriptors.  To  do  this,  turn  cells  are  check- 
ed to  see  if  they  are  adjacent  to  a  terrain- feature  vertex  or  edge.  This  procedure  may  create  a  spurious  bound- 
ary if  a  path  turns  twice  within  one  cell  of  a  vertex,  a  case  which  would  happen  at  a  comer  which  formed  a 
very  acute  angle,  for  example,  a  river  end.  In  this  case,  a  spurious  boundary  would  he  along  the  side  of  the 
river  segment  away  from  tlie  start  point.  We  must  also  specify  from  which  side  a  path  crosses  an  edge,  be- 
cause a  path  may  leave  an  area  across  an  edge  and  then  reenter  it  across  the  same  edge.  This  type  of  path  is  il- 
lustrated in  Figure  16b,  Frame  4,  starting  at  the  cell  labeled  A.  The  path  from  A  has  a  path  hst  [A,C,D,G], 
while  a  path  from  cell  B  has  a  path  Ust  [C,D,G].  When  comparing  cells  A  and  C  (the  first  cells  on  the  two 
paths)  to  determine  if  A  and  B  have  a  boundary  between  tliem,  we  must  be  able  to  determine  that  the  first  paUi 
crosses  ouf  o/thc  high-cost  area  at  A.  wliile  the  second  path  crosses  info  the  area  at  C,  and  so  the  paths  have 
different  behavior.  This  set  of  heuristics  provides  the  abiUty  to  detect  boundaries  inside  homogeneous-cost 
areas,  across  rivers,  and  across  roads.  Tlie  procedures  set-optimal-path-list  and  check-equivalent-paths  arc 
listed  in  Table  2  with  the  appropriate  changes. 

Figure  16  shows  tlie  above  heuristics  ui  operation.  There  is  a  very  close  correspondence  between  the 
boundaries  of  Figure  16b,  Frame  5,  and  tlie  theoretically  correct  boundiu-ies  for  an  exact  optimal-path  map. 
Few  spurious  boundaries  arc  generated.  For  example,  llicrc  are  too  many  boundaries  emanating  from  the  far 


TABLE  2 

WAVEFRONT-PROPAG ATION  OPM  ALGORITHM 

CHANGES  FOR  VERTEX-EDGE  VERSION 


procedure  set-optimal-path-list 
input;  Cell 

{ 

if  (Parent  of  Cell  is  on  Edgei  and  OPL-Parent  of 

Parent  of  Cell  is  not  on  Edgei) 

OPL-Parent  of  CeU  :=  Parent  of  Cell; 
else  if  (Parent  of  Cell  is  on  line  segment  between 

Cell  and  OPL-Parent  of  Parent  of  Cell) 

OPL-Parent  of  CeU  ;=  OPL-Parent  of  Parent  of  Cell; 
else 

OPL-Parent  of  CeU  ;=  Parent  of  Cell; 


/*  REVISED  PROCEDURE  */ 


/*  include  a  cell  in  OPL  for  each  boundary-  */ 
/*  crossing  episode.  */ 

/*  SAME  AS  PREVIOUS  VERSION  */ 


/*  end  of  optimal-path-Ust  */ 


procedure  check-equivalent-patlis 

input;  OPLl,  the  OPL-Parent  of  Neighbor-Cell 

and  0PL2,  the  OPL-Parent  of  Current-Cell 
output;  returns  TRUE  if  paths  are  equivalent,  FALSE  otherwise 


if  (OPLl  =  0PL2  =  [goal-point]) 

retum(TRUE); 
else 

{ 

for  i  =  1  to  2 

until  ((fu^st  cell  of  OPLi  is  adjacent  to 

a  cell  marked  "vertex")  or  (first  cell  of 

OPLi  is  marked  "edgej")) 

OPLi  :=  OPLi  less  first  cell: 
if  ((first  cell  of  OPLl  =  first  cell  of  0PL2) 
or  (first  cell  of  OPLl  is  on  the  line 

between  first  and  second  cells  of  0PL2) 
or  (first  cell  of  0PL2  is  on  the  Line 

between  first  and  second  cells  of  OPLl) 
or  ((edgei  =  edgej)  and 

check-equivalent-pathsiOFLl  less  first 

cell,  OPL2  less  first  cell)) 
Boundar}-Flag  ;=  TRUE: 
else  Boundary-Flag  :=  FALSE; 
) 


/*  REVISED  PROCEDURE  */ 


/*  Consider  only  cells  which  are  */ 
/*  adjacent  to  terrain-feature  vertices  */ 
/*  or  represent  edge-crossing  episodes  */ 
/*  Paths  are  equivalent  if  each  */ 
/*  pair  of  cells  are  equivalent  */ 


/*  NEW  CONDITION  */ 


) 


/*  end  of  check-equivalent-paths  */ 
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right  vertex  of  the  high-cost  area.  And  few  boundaries  are  overlooked,  although  some  shadow  boundaries  do 
not  appear.  For  example,  a  shadow  boundar>'  should  emanate  from  the  lower  right  vertex  of  the  obstacle;  in 
Chapter  V  we  develop  analytic  characterizations  of  homogeneous-behavior  boundaries  and  find  that  the  linear 
boundaries  incident  upon  vertices  should  act  as  if  they  were  shadows  with  the  goal  acting  as  a  point  light 
source.  Also,  the  curved  boundaries  on  llie  liidden  side  of  obstacles  should  be  hyperbolas,  and  the  curved  boun- 
daries inside  homogeneous-cost  areas  should  have  monotonic  curvature.  From  these  comments,  it  can  be  seen 
that  the  boundaries  generated  by  the  vertex-edge  version  (as  well  as  the  other  versions  of  wavefront  propaga- 
tion) have  some  error  in  location  and  shape,  although  they  may  suffice  for  many  applications. 

C.    RECONSTRUCTING  OPTIMAL  PATHS  FROM  WAVEFRONT  PROPAGATION 
OPTIMAL-PATH  MAPS 

How  can  we  reconstruct  the  optimal  path  from  the  start  point  knowing  the  node  of  the  optimal-path  tree 
which  descibes  its  behavior?  The  answer  depends  on  what  information  is  available  in  the  nodes,  which  will 
be  different  depending  on  tlie  version  of  wavefront  propagation,  because  homogeneous-behavior  regions  are 
defined  differently  for  each  version.  For  the  pure  or  diverging-path  version,  each  optimal-path-tree  node  rep- 
resents a  single  cell.  Because  intennediate  turn  cells  on  the  portion  of  a  path  which  lies  within  a  homogeneous- 
behavior  region  are  a  result  of  the  mechanics  of  the  algorithm,  and  not  of  terrain-feature  influence,  a  path  can 
be  approximated  by  plotting  straight  lines  from  a  start  cell  to  the  cell  of  the  node  representing  the  region  in 
which  the  start  cell  lies,  another  straight  line  from  that  cell  to  its  parent  in  the  optimal-path  tree,  and  so  on  back 
to  the  goal.  This  type  of  path  no  longer  confonns  to  the  grid-based  model;  otherwise,  some  "stair-step"  ap- 
proximation of  the  line  would  be  required.  By  Theorem  1-2,  in  the  type  of  terrain  considered  herein,  paths  are 
straight-line  segments  except  at  terrain- feature  vertices  or  edges.  So  the  vertex-edge  version  can  use  the  above 
method  for  paths  from  start  cells  to  nodes  representing  vertices,  and  between  vertices.  Between  edges,  further 
processing  would  be  necessary  to  determine  where  along  an  edge  a  given  path  would  cross  using  Snell's  Law 
as  discussed  in  Chapter  II. 
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IV.  ANALYSIS  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 

ALGORITHMS 

A.    SOURCES  OF  ERROR  IN  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

A  problem  with  using  waveftont  propagation  lo  generate  optimal-path  maps  is  that  the  inherent  error  of 
the  algorithm  is  carried  forward  to  the  0PM.  As  stated  previously,  Richbourg  [Ref.  20]  showed  that  an  upper 
bound  on  the  error  factor  of  the  cost  of  a  model-optimal  path  generated  by  the  point-to-point  wavefront 
propagation  algorithm  compared  with  the  cost  of  the  corresponding  real-world  optimal  path  is  cos(7r/8) ,  or 
about  7.6%.  The  fact  tbat  tlie  shapes  of  boundaries  generated  by  wavefront  propagation  are  otJy  approxima- 
tions of  the  correct  shapes  derived  in  Chapter  V  reflects  the  error  in  the  shape  and  cost  of  optimal  paths  in- 
herent in  wavefront  propagation. 

The  optimal -patli  map  in  our  approach  does  not  retain  information  about  all  the  intennediate  cells  where 
each  path  turns,  and  so  we  cannot  reproduce  tlie  palli  exactly  as  generated  by  wavefront  propagation.  If  we 
could,  however,  the  upper  bound  on  percent  error  of  7.6%  would  remain  in  effect,  because  nolliing  in  the  0PM 
algorithms  of  Chapter  111  affected  how  the  wavefront  expanded  from  cell  to  cell.  The  backpaths  of  Figures  14, 
15,  and  16  are  all  identical  (compare  Frame  4  of  each  figure),  and  only  tlie  boundaries  differ.  Although  we 
cannot  reconstruct  a  patli  exactly  as  generated  by  wavefront  propagation,  the  straight-line  approximation 
method  proposed  in  Section  C  of  Chapter  III  actually  produces  a  path  as  good  or  better  in  cost  than  the 
wavefront  propagation  path.  Straight-line  approximations  of  a  path  always  go  through  the  region  root,  which 
was  on  the  original  path.  They  also  he  completely  within  an  area  of  homogeneous  cost,  because  homogeneous- 
behavior  regions  are  star-shaped  with  respect  to  the  region  root  (Corollar>'  1-1.4).  By  the  triangle  inequality, 
their  cost  is  always  less  than  or  equal  to  the  original  path.  So  since  costs  of  straight-line  approximations  are 
lower  bounds  on  costs  of  wavefront-generated  paths,  the  previously  staled  upper  bound  on  percent  error 
remains  a  valid  upper  bound.  Can  this  upper  bound  be  improved? 

Although  in  the  case  of  most  start  cells,  substantial  improvement  over  the  cost  of  model-optimal  paths 
generated  by  wavefront  propagation  will  be  achieved  by  this  path  recoastruction  method,  the  upper  bound  on 
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error  cannot  be  lightened  in  general,  because  there  will  be  situations  where  the  error  in  placement  of  a  bound- 
ary would  cause  a  start  point  to  be  placed  in  an  incorrect  region,  (although  without  exceeding  the  upper  bound). 
An  example  of  such  a  case  occurs  in  Frame  5  of  Figure  16,  at  the  point  labeled  X.  The  optimal  path  from  point 
X  should  be  a  straight  line  to  the  goal.  But  since  wavefront  propagation  caused  error  in  the  placement  of  the 
vertical  boundary  (it  should  have  been  a  "shadow  boundary,"  a  ray  from  the  upper  left  vertex  of  the  high-cost 
area  extending  directly  away  from  the  goal  point),  X  is  to  the  right  of  the  vertical  boundary  instead  of  to  its 
left,  so  it  is  associated  with  the  region  whose  root  is  the  top-left  edge  of  the  high-cost  area.  Thus,  a  reconstructed 
path  will  go  in  a  straight  line  to  the  top  of  the  high-cost  area,  and  then  cut  across  its  comer  and  go  the  the  goal. 
This  path  has  a  cost  error  close  to  the  original  upper  bound. 

Tlius  the  upper  bound  on  percent  error  of  the  cost  of  wavefront-propagation-generated  model-optimal 
paths  with  respect  to  real-world  optimal  paths  remains  as  stated  for  the  point-to-point  version  of  the  algorithm , 
i.e.,  7.6%,  although  average  error  will  be  improved  by  appropriate  reconstruction  of  paths  from  the  optimal- 
path  map. 

B.    TIME  COMPLEXITY  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

As  stated  in  Chapter  II,  point-to-point  wavefront  propagation  implemented  using  Dijkstra's  algorithm  has 
worst-case  time  complexity  0(m  log  m),  where  tliere  are  m  cells  in  the  input  map.  In  Algorithms  B- 1  (Appen- 
dix B)  and  ID-l  (Chapter  III),  however,  the  algorithm  is  modelled  on  the  wavefront  analogy,  and  Dijkstra's 
algorithm  is  not  followed  exactly  (because  cells  may  remain  on  the  wavefront  for  more  than  one  iteration,  and 
a  search  for  the  minimum-cost  edge  is  not  done  for  each  wavefront).  As  explained  in  Chapter  II,  the  time  com- 
plexity of  this  version  is  0(c  m),  where  c  is  the  maximum  cost  of  a  cell  in  the  input  map,  time  is  incremented 
by  1  unit  each  step,  and  it  is  assumed  that  there  is  some  upper  bound  on  the  size  of  c. 

Tlie  mechanism  for  detecting  boundaries  is  to  check  each  cell  on  the  wavefront  against  each  of  its  eight 
neighbors.  There  are  eight,  or  O(constant)  ciiecks  for  each  of  the  m  cells  in  the  map.  Each  boundiu^'  check  in 
the /;;</f' version  consists  of  an  O(con.stant)  comparison  of  Uie  Orst  turn  points  on  the  backpaths  of  the  two  cells 
being  checked.  So  boundiu^-chccking  takes  0(ni)  time.  This  is  added  to  the  time  for  the  basic  algorithm,  so 
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the  pure  version  of  wavefront-propagation  oplinial-path-map  generation  lias  the  same  asymptotic  worst-case 
time  complexity  as  poinl-to-poiiit  wavefront  propagation,  or  0(c  m). 

In  the  diverging-path  version  of  wavefront-propagation  optimal -path-map  generation,  the  boundary  check 
consists  of  a  comparison  of  the  distance  between  the  parents  of  the  parents  of  the  two  cells.  Again  it  is  an 
O(constant)  operation  to  follow  two  back-pointers  for  each  cell  and  compute  a  distance,  so  boundary-check- 
ing takes  0(m)  time,  and  the  diverging-path  version  is  also  0(c  m). 

The  vertex-edge  version  of  wavefront-propagation  optimal-path-map  generation  uses  the  same  patli  lists 
as  the  pure  version,  but  considers  only  so-called  distinguished  cells  on  the  lists.  A  check  of  tlie  first  two  dis- 
tinguished cells  in  a  path  list  by  procedure  check-equivalent-paths  will  give  a  conclusive  answer  about 
whether  or  not  two  patlis  are  "similarly  behaved".  This  check  is  an  O(constant)  process  where  the  first  element 
in  each  list  is  retrieved,  and  the  two  elements  compared.  So  the  vertex-edge  version  also  has  worst-case  time 
complexity  0(c  m). 

As  discussed  in  Chapter  III,  the  vertex-edge  version  requires  preprocessing  of  the  terrain  to  fit  groups  of 
homogeneous-cost  cells  to  polygons  or  line  segments,  and  to  find  vertices  and  edges.  The  algorithm  of  Wade 
and  Rowe  [Ref.  44]  which  does  this  has  two  passes.  The  first  pass  processes  each  cell  once,  in  total  0(m)  time. 
The  second  pass  is  recursive,  and  a  worst-case  time  complexity  is  not  given,  but  for  a  map  witli  k  edge  cells, 
is  approximately  0(log  k).  Under  the  above  assumptions,  the  number  of  edge  cells  is  significantly  less  than 
the  number  of  cells,  so  k<m.  Therefore  the  terrain  preprocessing  is  dominated  by  the  wavefront  propagation 
algorithm. 

C.    SPACE  COMPLEXITY  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

The  space  required  for  the  point-to-point  wavefront  propagation  algorithm  is  simply  0{m),  where  the 
input  map  has  m  cells.  Storage  is  usually  implemented  by  a  Vm  by  Vm  array  which  holds  cost  information 
and  a  pointer  to  tlie  parent  of  the  cell  on  its  backpath.  During  execution,  another  data  structure  will  hold  the 
coordinates  of  those  cells  currently  on  the  wavefront.  When  the  algorithm  is  expanded  to  deal  witli  tlie  two- 
dimensioniil,  or  optinuil-palh-map  case,  sevcr;il  new  data  structures  must  be  added.  First,  for  tlie  pure  and  the 
vertex-edge  versions,  two  fields  must  be  added  to  the  cell  array  to  hold  the  coordinates  of  the  cell's  parent  on 
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the  optimal -path  list  (in  general  not  the  cell's  parent  on  the  backpath).  Secondly,  new  data  structures  must  be 
added  to  hold  the  output.  These  data  structures  are  the  DCEL  and  the  optimal-path  tree. 

As  explained  in  Chapter  II,  Section  B,  a  doubly-connected  edge  list  (DCEL)  along  with  an  optimal -path 
tree  are  well  suited  to  representing  tlie  optimal-path  map.  The  size  of  the  optimal-path  tree  is  proportional  to 
the  number  of  homogeneous-behavior  regions  in  the  optimal-path  map,  since  there  is  one  node  per  region. 
Since  in  tlie  worst  case  there  could  be  no  more  than  one  region  per  cell,  the  optimal-patli  tree  will  never  re- 
quire more  than  0(m)  storage.  In  fact  as  discussed  above,  the  number  of  regions  is  assumed  to  be  significant- 
ly larger  than  tlie  number  of  cells,  so  the  optimal-patli  tree  will  only  require  a  small  fraction  of  the  total  number 
of  cells  in  tlie  input  map,  and  is  more  accurately  a  function  of  tlie  number  of  terrain  feature  vertices  and  edges, 
orO(v  +  e). 

The  DCEL  represents  the  planar  partition  by  listing  characteristics  of  each  line  segment,  or  edge,  in  the 
partition.  Since  each  segment  of  the  wavefront-propagation-OPM  boundaries  is  designated  as  lying  between 
two  specified  cells,  there  can  never  be  more  tlian  0(m)  boundary  segments,  and  in  fact,  the  one-dimensional 
nature  of  boundaries  will  tend  to  produce  an  DCEL  of  OCvm)  size.  In  lenns  of  terrain- feature  vertices  and 
edges,  it  is  shown  in  Chapter  V  tliat  any  given  vertex  or  edge  has  a  constant  number  of  region  boundaries  as- 
sociated with  it,  so  the  DCEL  will  have  size  of  0(v  -i-  e).  Note  that  the  0(m)  input  map  can  be  discarded  after 
preprocessing,  so  the  amount  of  storage  needed  at  run-time  will  be  0(v  +  t). 

In  practice,  a  great  amount  of  storage  can  be  saved  in  the  way  the  planar  partition  is  represented  by  the 
DCEL.  As  produced  by  the  wavefronl-propagalion  OPM-generation  algorithm,  boundaries  are  represented  by 
lists  of  cell  edges  (perhaps  implemented  simply  by  listing  coordinates  in  the  same  coordinate  system  as  the 
cells,  but  incremented  or  decremented  by  .5).  But  in  fact,  boundaries  in  the  grid-based  domain  typically  con- 
lain  long,  near-linear  sequences,  so  the  number  of  edges  in  the  DCEL  can  be  reduced  greatly  by  representing 
only  endpoints  of  such  sequences.  Figure  16  shows  about  half  of  the  boundaries  to  be  linear. 

D.    EMPIRICAL  PERFORMANCE  OF  WAVEFRONT-PROPAGATION  OPM 
IMPLEMENTATIONS 

The  three  versions  of  the  OPM-gcneration  algorillini  described  in  Section  B  of  Chapter  III  were  implc- 
menlcd  in  Common  Lisp  on  a  Symbolics  3620  Lisp  Macliine.  Although  no  special  effort  was  made  ic)  make 
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these  implementations  efficient,  some  idea  of  the  relative  performance  of  the  four  versions,  and  some  rough 
idea  of  tlie  performance  of  wavefront  propagation  in  general,  can  be  gained  by  observing  actual  run-times. 
Table  3  shows  average  elapsed  times  for  two  typical  input  maps,  based  on  the  Lisp  function  "gel-universal- 
time".  These  real-time  figures  give  some  rough  idea  of  the  actual  performance  of  these  implementations. 
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TABLE  3 
WAVEFRONT-PROPAGATIONOPM-GENERATION 
RELATIVE  PERFORMANCE  OF  THREE  VERSIONS 


Man  Number 


Version  Version  Version 


1 

(average  CPU  Time) 
(average  Real  Time) 


449,759  cycles     793,094  cycles     2,292,827  cycles 
493  sec  843  sec  2,440  sec 


(average  CPU  Time) 
(average  Real  Time) 


1,558,722  cycles  916,535  cycles     2,013,910  cycles 
1,714  sec  973  sec  2113  sec 


NOTES: 

(1)  Average  CPU  Time  is  elapsed  time  as  per  machine-dependent  LISP  function  "get-intemal-run-time" 
averaged  over  eight  runs. 

(2)  Average  Real  Time  is  elapsed  time  as  per  LISP  function  "get-universal-time"  averaged  over  eight  runs. 

(3)  Vereions  were  implemented  in  Common-Lisp  on  a  Symbolics '^'^  3640  operating  under  Genera  4.1^". 

(4)  Map  1  was  199  by  150  cells  (i.e.,  29850),  with  one  obstacle  and  one  high-cost  feature,  12  vertices  and 
12  edges,  with  465  cells,  or  1.5%,  of  infinite  cost  (obstacle  cells)  and  741  cells,  or  2.5%,  of  cost  two. 

(5)  Map  2  was  199  by  150  cells  (i.e.,  29850),  with  tliree  obstacles,  15  vertices  and  15  edges,  with  619  cells, 
or  2. 1  %,  of  infinite  cost. 
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V.  CHARACTERIZATION  OF  REGION  BOUNDARIES 

In  this  chapter,  we  formulate  the  geometrical  groundwork  necessary  for  an  0PM  construction  algorithm 
which  relies  on  spatial  reasoning  to  eliminate  much  of  the  inaccuracy  inherent  in  the  wavefront  propagation 
0PM  construction  algorithm.  The  algorithm  applies  to  maps  consisting  of  the  five  types  of  terrain  defined  in 
Chapter  1,  Section  E,  obstacles,  roads,  rivers,  homogeneous-cost  areas  (HCA),  and  homogeneous-cost  back- 
ground. The  approach  we  use  is  to  detennine  the  analytic  characteristics  of  boundaries  between  regions  of 
similarly-behaved  optimal  paths  as  functions  of  terrain  feature  characteristics.  It  turns  out  that  all  boundaries 
associated  with  the  fir^t  three  of  the  above  terrain  feature  types  (roads,  rivers,  and  obstacles)  are  segments  of 
conic  sections.  Boundaries  associated  with  HCA's  are  more  mathematically  complex,  and  in  many  cases  do 
not  appear  to  have  closed-fonn  expressions.  In  addition  to  the  algebraic  form  of  these  boundaries,  we  develop 
the  theory  which  describes  the  circumstances  in  wliich  each  type  of  boundary  occurs.  The  algorithms  described 
in  Chapter  VI  will  rely  on  the  results  developed  in  tliis  chapter  for  the  basic  steps  involving  construction  of 
each  boundary. 

Firsi, primitive  terrain  features,  that  is  single  polygonal  obstacles  and  homogeneous-cost  areas,  and  suigle 
river  and  road  line  segments,  are  studied  and  the  boundaries  they  generate  are  characterized.  Then  a  unifying 
tlieory  is  introduced  which  underlies  all  types  of  boundaries  as  they  occur  in  terrain  as  defined  herein.  Develop- 
ment of  algorithms  for  constructing  OPM's  for  each  of  the  primitive  terrain  features  and  for  combined  terrain 
is  deferred  until  Chapter  VI.  Appendix  C  contains  additional  examples  of  optimal-path  maps  for  each  of  the 
primitive  terrain  features  presented. 

A.    REGION  BOUNDARIES  ASSOCIATED  WITH  PRIMITIVE  TERRAIN  FEATURES 

Table  4  summarizes  the  types  of  homogeneous-behavior-region  boundaries  associated  with  each  type  of 
primitive  terrain  feature.  Each  type  of  terrain  feature  is  listed  in  the  left  column.  The  second,  third,  fourth,  and 
fifth  columns  contain  the  names  of  the  boundary'  types  associated  with  that  terrain  feature  which  are  Unear, 
parabolic,  hyperbolic,  and  non-conic  respectively.  Since  there  are  four  cases  of  homogeneous-cost  area  (HCA) 
depending  on  whether  the  goal  is  inside  or  outside  the  HCA  and  on  whetlier  the  HCA  cost  is  higher  or  lower 
than  tlie  surrounding  terrain,  each  of  wliich  has  distinctively  different  boundaries,  these  four  cases  are  listed 
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TABLE  4 

SUMMARY  OF  HOMOGENEOUS-BEHAVIOR-REGION 

BOUNDARIES  BY  TERRAIN  TYPE 


FORM  OF  BOUNDARY 


LIl^AR 

PARABOLIC 

HYPERBOLIC 

NON-CONIC 

Obstacle 

Shadow(c/c) 
Obstacle-edge 

Opposite-edge(c/c) 

River  Segment 

Shadow(c/c) 
River-edge 

River-opposite-edge(c/c) 
River-crossing(c/c) 

Road  Segment 

Road-edge 
Rd-end/road- 

tvlg(c/p) 
Rd-tvlg/road- 

crossing(p/c) 
Shadow(c/c) 

Near-side-road- 
traveUing/goal(p/c) 

Far-side-road- 
traveIling/goal(p/c) 

Road-end/goal(c/c) 

High-Cost 

HCA-edge 

Opp-edge-O-thru- 

Visible-edge{d/d) 

Exterior-Goal 

Hidden-edge/ 

inlerior(c/c) 

Visible-liidden- 

HCA 

merging-path(p/p) 

Opp-edge-1-thru- 

edge(d/p) 

Hidden-edge/ 

interior(c/d) 

Comer- 

diverging-pailHp/p) 

Opp-edge-2-thru 

culting(c/d) 

Shadow(c/c) 

interior(d/d) 

High-Cost 

HCA-edge 

Hidden-edge/goal  (p/c) 

Exterior-opposite- 

Comer-cutting 

Interior-Goal 

Shadow 

Visible-edge/goal(,p/c) 

edge(c/c) 

(c/dj 

HCA 

Hidden-edge(p/p) 

Visible-edge(d/d) 

Interior-opposite 

-edge(p/p) 

Low-Cost 

HCA-edge 

Edge-following/goa](p/c)  Vertex/goal(c/c) 

Edge-xing/(d/c) 

Exterior-Goal 

Venexyedge-following(c/pj 

Opposiie-edge(d/d) 

HCA 

Vertex-edge-crossing(c/d) 

Visible-edge(.d/d) 

Low-Cost 

HCA-edge 

Interior-Goal 

Vertex/edge-crossing(c/d) 

HCA 

Multiple- 

Shadow(c/c) 

River-opposiie-edge(c/c) 

Connected 

River-edge 

River-crossing(c/c) 

River  Segments 

Near-side-river-crossing(  c/c) 
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separately.  Also  listed  with  each  boundary'  name  is  a  coded  description  of  what  type  of  cost  functions  are  as- 
sociated with  tlie  homogeneous-behavior  regions  on  either  side  of  the  boundary.  The  code  "c"  means  the  cost 
function  of  a  region  is  conical,  "p"  means  it  is  planar,  and  "d"  means  it  is  a  "distorted  cone".  Terrain-feature 
edges  always  form  boundaries,  which  of  course  are  linear  since  terrain- feature  edges  are  linear,  but  are  not  as- 
sociated with  a  particular  cost  function,  so  no  code  is  shown.  (See  Section  C  for  a  discussion  of  cost  functions.) 
1.     Obstacles 

We  begin  by  characterizing  boundaries  associated  with  a  single  obstacle  in  homogeneous-cost  back- 
ground terrain  (see  Theorem  V-1,  Appendix  A).  (The  types  of  boundaries  associated  with  obstacles  have  pre- 
viously been  determined  by  Mitchell  [Ref.  4]  using  different  terminology.)  With  respect  to  obstacles,  define 
a  visible  edge  to  be  an  edge  for  which  no  point  on  tlie  edge  has  an  optimal-path  list  whose  first  element  lies 
on  the  obstacle  perimeter.  Define  a  hidden  edge  as  a  non- visible  edge,  i.e.,  an  edge  for  which  some  point  on 
the  edge  has  an  optimal-path  hst  whose  first  element  lies  on  the  obstacle  perimeter.  In  the  case  of  terrain  con- 
taining only  a  single  obstacle,  this  means  that  both  visible-edge  vertices  are  visible  to  the  goal  point.  In  Figure 
17,  edges  AB  and  BC  are  visible  edges.  Edges  CD,  DE,  and  EA  are  hidden  edges.  (Many  of  the  following 
figures  are  similar  in  format.  Terrain  features  are  shown  as  polygons  or  line  segments.  Homogeneous-behavior- 
region  boundaries  are  shown  as  solid  curves.  Occasionally  continuations  of  the  boundaries  are  shown  as  dashed 
lines  to  clarify  the  form  of  a  boundary.  In  many  of  the  figures  a  field  of  small  vectors  represents  the  initial 
direction  of  the  optimal  paths  from  a  sampling  of  start  points.  These  fields  are  not  part  of  the  optimal-path 
map.  but  serve  to  illustrate  the  directions  paths  take  and  to  corroborate  the  correctness  of  plotted  boundaries.) 
Define  an  opposite  edge  to  be  Uie  obstacle  hidden  edge  for  which  the  optimal  path  lists  of  neither  vertex  in- 
cludes the  other.  An  isolated  obstacle  has  exactly  one  opposite  edge  (Lemma  V-1. 3,  Appendix  A).  Edge  DE 
is  the  opposite  edge  in  Figure  17.  A  special  case  is  that  in  which  the  role  of  the  opposite  edge  is  assumed  by 
an  obstacle  vertex:  this  is  ruled  out  by  the  general  position  assumption  discussed  in  Chapter  I,  although  the 
analysis  for  including  such  a  case  is  a  simple  extension  of  the  below.  Define  an  opposite  point  as  the  point  on 
tiie  opposite  edge  with  two  distinct  optimal  paths,  one  Uirough  each  vertex  of  the  opposite  edge. 

There  are  three  types  of  boundaries  associated  with  obstacles.  Obstacle  edges  are  trivial  boundaries, 
since  they  separate  regions  whose  optimal-path  lists  are  [[J.  goal-point]  from  regions  witli  non-degenerate  op- 
tiinaJ-path  bsts  (see  Lemma  V-l.lj.  Obstacle  shadows  emanate  from  vertices  of  hidden  edges  in  a  straight 
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Figure  17 
Obstacle 
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line,  as  if  the  goal  were  a  point  light  source;  each  vertex  of  a  hidden  edge  generates  a  shadow  boundary.  For 
those  vertices  wliich  join  a  hidden  edge  and  a  visible  edge,  the  line  segment  lies  on  the  line  defined  by  the  ver- 
tex and  the  goal;  for  those  vertices  which  join  two  hidden  edges,  the  line  segment  lies  on  the  line  defined  by 
that  vertex  and  the  vertex  of  the  hidden  edge  which  is  included  in  the  first  vertex's  optimal  path.  (See  Figure 
17  and  Lemma  V-1.2,  Appendix  A). 

Each  obstacle  also  has  exacdy  one  opposite-edge  boundary  which  emanates  from  the  opposite  edge 
of  an  obstacle,  and  consists  of  segments  of  hyperbolas.  This  follows  directly  from  the  definition  of  a  bound- 
ary by  the  application  of  basic  analytical  geometry  (see  Lemma  V- 1 .4,  Appendix  A).  The  hyperbola  is  defined 
by  considering  the  vertices  Vi  and  V2  of  the  opposite  edge  as  foci.  Choosing  a  coordinate  system  such  that 
the  x-axis  intersects  both  foci  and  the  origin  is  mid- way  between  them,  Equation  1  describes  the  opposite-edge 
boundary.  Forcing  constant  a  to  be  positive  restricts  Equation  1  to  the  one  branch  of  the  hyperbola  which  is 
closer  to  the  higher-cost  focus.  The  segment  of  this  branch  which  is  active  as  a  boundary  begins  at  the  point 
on  the  opposite  edge  intersected  by  the  branch  and  continues  away  from  the  obstacle.  (See  Figure  17). 

2         2 
(EquaUonl)  ^  - -^     =    c^  where     a  =  (IGV2I  -  IGViI)/2,    IGV2l>IGVil, 

c  =  IV1V2I/2,     and  b   =c  -a. 

If  at  any  point  the  opposite-edge  boundary  intersects  a  shadow  boundary,  it  wUl  become  defined  by 
another  hyperbola  from  that  point  on.  This  second  hyperbola  is  defined  by  considering  as  foci  (1)  the  vertex 
of  the  edge  associated  with  the  shadow  boundary  and  which  is  the  closer  to  the  goal  of  the  two  vertices  of  that 
edge,  and  (2)  the  focus  of  the  previous  hyperbola  which  is  not  also  a  vertex  of  the  edge  associated  with  the 
shadow.  The  hyperbolic  constant  is  computed  as  before,  using  the  costs  from  the  foci  to  the  goal.  Tlie  segment 
begins  at  the  point  where  the  second  hyperbola  intersects  the  first  hyperbola,  and  continues  away  from  the 
obstacle.  The  direction  of  curvature  of  the  second  hyperbola  may  be  the  same  or  opposite  that  of  the  first.  (See 
Figure  17). 

2.     River  Segments 

Single  isolated  river  segments  generate  four  types  of  boundaries  (see  Figure  18  and  Theorem  V-2. 
Appendix  A).  River-edges  are  trivial  boundiuies  (Lemma  V-2. 1 ).  Shadow  boundaries  are  associated  with  each 
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Figure  18 
Rivei  Segment 
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river  vertex,  and  are  half-lines  starting  at  a  river  vertex  and  lying  directly  away  from  the  goal  (Lemma  V-2.2). 
River-crossing  boundaries  differentiate  between  paths  that  cross  a  river  and  ones  that  go  around  its  end.  A 
river-crossing  boundary  is  a  segment  of  a  hyperbola  defined  by  considering  the  river  vertex  V  and  the  goal  G 
as  foci,  with  the  constant  in  Equation  1  being  a  =  IVGI/2.  The  segment  begins  at  the  point  at  which  the  hyper- 
bola intersects  the  river  and  ends  at  the  point  at  which  it  intersects  the  river-obstacle  boundary  (below).  This 
type  of  boundary  may  not  appear  if  the  river-crossing  cost  is  too  high  or  if  the  angle  between  the  river  and  the 
goal-to-river-end  line  approaches  or  exceeds  90".  (Lemma  V-2.3).  A  river  segment  will  act  like  an  obstacle 
when  the  distance  of  the  start  point  to  the  river  plus  the  river-crossing  cost  is  large  compared  with  the  distance 
from  the  river  to  the  goal.  If  this  occurs,  a  boundary  will  start  at  the  intersection  of  the  two  river-crossing  boun- 
daries, if  they  exist,  or  if  not  at  the  river  edge.  This  opposite-edge  boundary  will  be  a  hyperbola  defined  by  the 
two  river-end  vertices  V  i  and  V2  as  in  the  obstacle  opposite-edge  case  above .  (Lemma  V-2.4).  The  river  shadow 
boundaries  will  never  intersect  the  opposite-edge  boundary,  so  it  will  consist  of  only  one  hyperbola  segment. 
3.     Road  Segments 

Single  isolated  road  segments  are  associated  with  various  types  of  boundaries,  depending  on  their 
orientation  with  respect  to  the  goal  (Theorem  V-3,  Appendix  A).  Consider  a  wedge  with  the  goal  G  as  the  ver- 
tex, fonned  by  extending  two  rays  from  G  through  the  line  of  the  road  intersecting  the  line  at  two  points  A  and 
B,  so  that  tlie  interior  angles  GAB  and  GBA  are  the  angle  Yc  =  7l/2— 9c,  Oc  the  critical  angle  such  that  9c  = 
sin"  (R/S),  for  R  the  road  cost,  and  S  the  cross-country  cost,  where  R  is  greater  than  S.  Call  this  the  charac- 
teristic wedge  of  the  road  segment.  (See  Figure  1 9.)  We  adopt  the  convention  for  the  following  discussion  that 
the  wedge  intersection  points  A  and  B  are  labelled  such  that  their  relative  positions  on  the  road  line  are  the 
same  as  the  relative  positions  of  the  two  road  vertices  Vi  and  V2  (e.g.,  if  Vi  is  to  the  right  of  V2  on  a  certain 
map,  then  A  is  to  the  right  of  B).  When  A  and  B  and  Vi  are  arrayed  along  the  road  line  in  the  order  B,A,Vi, 
(irrespective  of  V2's  position),  say  that  the  characteristic  wedge  is  inside  Vi.  When  they  are  arrayed  in  the 
order  B.Vi.A  or  when  A  and  Vi  are  the  same  point,  say  that  the  wedge  straddles  W].  When  they  are  arrayed 
in  the  order  Vi,B,A,  say  that  the  wedge  is  outside  Y\.  There  are  seven  types  of  boundaries  induced  by  road 
segments,  as  listed  below.  When  the  characteristic  wedge  is  inside  Vj,  types  a,b,c,  and  d  exist  on  the  Vi  end 
of  the  road  segment.  When  the  characteristic  wedge  straddles  Vi,  types  a  and  g  exi.st  on  the  Vi  end.  When  the 
characteristic  wedge  is  outside  Vi,  types  a,d,  and  f  exist  on  the  V2  end,  and  vice  versa.  When  the  characteris- 
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tic  wedge  is  inside  both  Vi  and  V2,  type  e  also  exists  on  each  end.  When  the  characteristic  wedge  is  inside  Vi 
and  straddles  V2,  type  e  exists  on  die  V|  end  only.  Figure  20  and  Figure  21  show  two  example  road  segments 
with  their  associated  boundaries  (labeled  a). 

Type  a:  Road-edge  boundaries  separate  paths  which  start  on  one  side  of  a  road  from  those  which  start 
on  the  other  side.  All  road  segments  will  constitute  road-edge  boundaries  (Lemma  V-3.1).  For  example,  the 
road  segment  V1V2  in  Figure  20  is  a  road-edge  boundary. 

Type  b:  Road-etidl road-travelling  boundaries  separate  paths  which  go  to  a  road  end  and  begin  using 
the  road  from  tliose  wliich  go  to  a  road  interior  point  and  begin  using  tiie  road.  They  are  linear,  and  form  a  fan- 
shaped  region  at  the  road  end.  When  the  characteristic  wedge  is  inside  a  road-end  vertex  V,  there  will  be  two 
road-end/road-travelling  boundaries  beginning  at  V  and  forming  angles  of  7t/2— 0c  and  0c— 7l/2with  the 
road.  (Lemma  V-3.2).  Figure  20  shows  four  such  boundaries  (labeled  b),  two  each  emanating  from  road  ver- 
tices V 1  and  V2,  because  the  characteristic  wedge  is  inside  both  V 1  and  V2.  Figure  21  shows  two  road-end/road- 
traveliing  boundaries  emanating  from  vertex  V2,  because  the  wedge  is  inside  V2,  but  none  from  Vi  because 
the  wedge  is  outside  Vi . 

Type  c:  Road-end/ goal  boundaries  separate  paths  which  travel  directly  to  the  goal  from  paths  that 
travel  to  a  road  end  and  then  along  tlie  road.  These  boundaries  are  segments  of  hyperbolas  where  road-end  V 
and  goal  G  are  the  foci,  and  the  hyperbola  is  described  by  Equation  1,  where  Vi=G  and  V2=V.  The  boundary 
begins  at  the  point  wliere  the  hyperbola  intersects  tlie  road-end/road-travelling  boundary.  A  road-end/goal 
boundary  exists  on  the  goal  side  of  tlie  road  segment  for  vertex  Vi  if  and  only  if  apafr  of  road-end/road-travell- 
ing  boundaries  exist;  if  the  characteristic  wedge  is  outside  V2,  a  road-end/goal  boundary  wUl  also  exist  on  the 
far  side  of  die  road  segment  for  vertex  Vi.  (Lenmia  V-3.3).  In  Figure  20,  two  such  boundaries  exist  (labeled 
c),  one  associated  with  each  vertex  of  the  road  segment,  and  both  on  the  goal  side  of  the  road,  although  tlie 
boundary  on  Uie  V2  end  is  not  shown  being  off  the  page  to  die  bottom.  In  Figure  21 .  two  such  boundaries  exist 
associated  with  V2,  although  bodi  are  off  the  page. 

Type  d:  Near-side  road-travelling/ goal  boundaries  lie  on  the  near  side  of  the  road  (i.e.,  on  the  goal 
side)  and  separate  padis  which  enter  a  road  interior,  travel  along  it,  and  tlien  exit  the  road  to  cut  over  to  the 
goal  from  those  which  go  directly  to  the  goal.  These  boundaries  are  described  by  segments  of  parabolas  defined 
for  road-end  vertex  V 1  as  follows:  the  focus  of  die  parabola  is  the  goal,  G,  and  the  directrix  is  the  line  perpen- 
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Figure  21 
Road  SegnieiU  Example  2 
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dicular  to  the  diaracteristic  wedge  ray  GB  and  which  intersects  the  ray  GB,  and  is  a  distance  IGAI  from  A  if 
the  characteristic  wedge  is  inside  Vi  and  not  outside  V2,  and  a  distance  IGV2I  from  V2  if  the  wedge  is  inside 
Vi  and  outside  V2.  This  parabola  is  described  by  Equation  2,  where  the  y-axis  is  the  directrix  and  the  x-axis  is 
the  axis  of  the  parabola. 

(Equation  2)  y   =  4  p  x  where     p  =  d  cos  (0c)/4 

for  d  =  IGAI  if  wedge  not  outside  V2, 
and  d  =  IGVil  if  wedge  is  outside  V2. 

The  segment  of  the  parabola  which  is  a  boundary  begins  at  point  A  if  the  characteristic  wedge  is  in- 
side Vi  and  not  outside  V2,  and  begins  at  point  V|  if  the  characteristic  wedge  is  inside  Vi  and  outside  V2.  It 
ends  at  the  point  where  the  parabola  intersects  the  near-side  road-end/road-travelling  boundary  and  the  road- 
end/goal  boundary  if  there  is  a  road-end  vertex,  and  continues  indefinitely  if  there  is  not.  It  exists  under  the 
same  conditions  as  these  two  exist.  (Lemma  V-3.4).  Figure  20  shows  two  near-side/road-traveUing  boundaries 
(labeled  d),  because  the  wedge  is  inside  both  Vi  and  V2.  Tlie  directrices  D|  and  D2  are  distances  IGAI  from  A 
and  IGBI  from  B  respectively,  because  the  wedge  is  inside  both  Vi  and  V2.  If  the  wedge  had  straddled  either 
vertex,  the  same  distances  would  continue  to  apply.  Figure  21  shows  one  near-side/road-travelling  boundary, 
but  this  one  has  a  directrix  (not  shown)  with  a  distance  IGVjl  from  V)  because  the  wedge  is  outside  Vi. 

Type  e:  Road-travelling/road-crossing  boundaries  separate  paths  which  begin  on  the  far  side  of  the 
road  from  the  goal  and  travel  along  the  road  from  those  which  also  begin  on  the  far  side  but  cross  the  road  and 
go  directly  to  the  goal.  This  type  of  boundary  will  exist  for  road-end  Vi  when  the  characteristic  wedge  is  in- 
side V|  and  not  outside  V2.  It  is  hnear  (a  ray),  and  is  the  portion  of  the  characteristic  wedge  ray  beginning  at 
A  and  lying  on  the  far  side  of  the  road.  (Lemma  V-3.5).  Figure  20  shows  examples  of  two  road-travelling/road- 
crossing  boundaries  which  occur  because  the  characteristic  wedge  is  inside  both  vertices.  Figure  2 1  has  no  such 
boundaries,  because  the  wedge  is  outside  V2. 

Type  f:  Afar-side  road-travelling/ goal  boundary  occurs  on  llie  Vi  end  when  the  characteristic  wedge 
is  outside  V|.  It  is  a  segment  of  a  parabola  with  focus  G  and  directrix  D  such  that  D  is  perpendicular  to  the  ray 
GA.  but  does  not  intersect  it  (i.e.,  D  lies  on  the  othcrside  of  G  from  A),  and  D2  is  distance  IViGI  from  \'|.  This 
p;u-abola  is  defined  similarly  to  tlie  one  in  Equation  2.  except  that  d=IV|GI.  One  far-side  road-travelling/goal 
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boundar>'  occurs  in  Figure  21  on  the  V2  end  of  road  segment  because  the  characteristic  wedge  is  outside  V2. 
Non  occurs  in  Figure  20,  because  the  wedge  is  outside  neither  vertex. 

Type  g :  A  toad-sliadow  boundary  occurs  wlien  the  characteristic  edge  straddles  a  vertex  V.  It  separates 
points  whose  paths  cross  the  road  en  route  to  the  goal  from  those  which  go  directly  to  the  goal.  The  shadow 
boundary  is  a  ray  starting  at  V  and  lying  directly  away  from  G.  (Lemma  V-3.7).  Note  that  since  paths  which 
cross  roads  pay  no  additional  cost,  this  type  of  boundary  occurs  only  by  convention.  We  want  path  descriptions 
to  reflect  each  terrain-feature-edge  crossing,  even  though  no  change  in  direction  or  cost  rate  occurs  for  this 
case.  This  type  is  not  illustrated  in  the  accompanying  figures. 
4.     Homogeneous-Cost  Areas  (HCA> 

Homogeneous-cost  areas  (HCA)  generate  boundaries  both  inside  and  outside  the  HCA.  The  outside 
boundaries  are  similar,  altliough  not  identical,  to  those  associated  with  obstacles,  rivers,  and  roads.  This  is  not 
surprising,  since  the  HCA  is  a  generalization  of  each  of  these  types  of  terrain.  There  are  four  cases,  based  on 
the  relative  costs  of  the  HCA  interior  and  exterior  and  the  location  of  the  goal  inside  or  outside  the  HCA.  We 
first  consider  the  case  where  the  cost  of  the  interior  of  the  HCA  is  greater  than  the  cost  of  the  exterior  and  the 
goal  point  lies  outside  the  HCA.  then  the  high-cost,  interior-goal  case,  the  low-cost  exterior- goal  case,  and  the 
low-cost  interior-goal  case. 

a.     High-Cost  HCA  With  An  Exterior  Goal 

When  the  goal  is  exterior  to  the  homogeneous-cost  area,  and  the  cost  of  the  HCA  is  greater  than 
the  surrounding  terrain,  boundaries  occur  according  to  Theorem  V-4,  Appendix  A.  Define  a  visible  edge  of  an 
HCA  to  be  an  HCA  edge  for  which  no  point  on  the  edge  has  an  optimal-path  list  whose  first  element  lies  on 
the  HCA  perimeter.  Define  a  hidden  edge  as  a  non-visible  edge,  i.e.,  an  edge  for  which  some  point  on  the  edge 
has  an  optinial-path  list  whose  first  element  hes  on  the  HCA  perimeter.  Thus  a  hidden  edge  may  have  points 
whose  optimal  paths  travel  through  the  HCA,  which  would  mean  that  their  optimal  paths  would  have  as  their 
first  element  the  visible  edge  across  which  tliey  pass.  Define  opposite-edge  sequence  as  the  smallest  connected 
sequence  of  hidden  edges  for  which  the  first  and  last  endpoints  of  the  edge  sequence  have  optimal  paths  whose 
initial  directions  follow  the  HCA  edges  in  opposite  (i.e.,  clockwise  versus  counterclockwise)  directions.  If  no 
.such  endpoint  can  be  found  at  one  end  or  tlie  other  of  the  sequence  of  hidden  edges,  let  the  endpoint  at  that  end 
be  the  "outer"  vertex  of  the  last  hidden  edge.  i.e..  the  vertex  wliich  joins  the  last  hidden  edge  in  the  clockwise 
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(or  counterclockwise)  direction  with  the  first  visible  edge  in  the  clockwise  (or  counterclockwise)  direction.  In 
Figure  22,  the  initial  direction  of  optimal  paths  for  each  edge  endpoint  is  shown  as  a  vector.  HCA  1  has  op- 
posite-edge sequence  ED,  HCA  2  has  opposite-edge  sequence  EDCB,  HCA  3  has  opposite-edge  sequence 
FED,  and  HCA  4  has  opposite-edge  sequence  JIHFE.  Essentially,  this  definition  specifies  the  range  over  which 
a  search  must  be  conducted  for  an  opposite  point,  if  one  exists,  and  defines  the  HCA  vertices  which  may 
generate  opposite-edge  boundaries  (see  below).  Define  the  opposite  point  of  an  HCA  as  a  point  with  two  op- 
timal paths  lying  in  opposite  directions  (i.e.,  clockwise  and  counterclockwise)  along  HCA  edges.  If  "shortcut- 
ting"  occurs  through  the  center  of  HCA,  the  opposite  point  might  not  exist,  as  in  HCA  2  and  HCA  3  of  Figure 
22. 

Define  the  critical  angle  Oc  of  an  HCA  as  sin"  (ci/c2)  where  the  ci  are  the  unit  costs  inside  and 
outside  the  HCA,  and  ci  >  C2.  An  optimal  path  crossing  an  HCA  edge  will  obey  an  analogue  of  Snell's  Law 
in  optics  [Ref.  20]  (see  Chapter  II,  Section  E)  so  that  for  angle  of  incidence  Oi  and  angle  of  refraction  02, 
and  cost  rates  ci  and  C2  on  either  side  of  the  edge,  ci  sin(Oi)=  C2sin(62).  (See  also  Chapter  II,  Section 
E2b(3)  and  Figure  II-8). 

Inside  a  high-cost  HCA  with  extemid  goal,  there  are  four  types  of  boundaries  (See  Figures  23, 
24,  and  25).  Each  pair  of  HCA  edges  is  potentially  associated  with  an  interior  boundary.  The  boundary  type 
depends  on  whether  the  edges  are  visible  or  hidden,  and  are  on  the  same  or  opposite  sides  of  the  opposite-edge 
bourxlary.  A  visible-edge  boundary  distinguishes  optimal  paths  which  go  through  two  different  visible  edges; 
the  optimal  paths  cross  their  respective  edges  according  to  Snell's  Law.  Lemma  V-4.1  (Appendix  A)  states 
the  analytic  form  of  such  a  boundary.  Although  not  expressible  in  closed  form,  the  boundar>'  has  much  the 
same  shape  as  a  hyperbola  segment  wliich  forms  an  obstacle  opposite-edge  boundary,  i.e,  it  has  positive  but 
decreasing  curvature  from  its  point  of  incidence  upon  an  HCA  vertex  inward  into  the  HCA,  and  this  curva- 
ture is  typically  small  so  that  the  curve  is  almost  linear.  An  example  of  a  visible-edge  boundary  is  found  in 
Figure  23,  labeled  a. 

A  xisible-hidden-edge  boundary  distinguishes  optimal  paths  going  through  a  visible  edge  from 
those  going  through  a  hidden  edge;  the  latter  paths  traverse  the  HCA  edge  at  exactly  the  critical  angle  and  the 
follow  the  edge.  Lemma  V-4.2  states  the  analytic  fom)  of  this  type  of  boundiu^-,  which  again  is  similar  to  a 
hyperbola.  Examples  of  this  type  of  boundary'  occur  in  Figures  23,  24.  and  25  and  lu-c  labeled  b. 
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A  hidden-edge  merging-path  boundary  distinguishes  optimal  paths  leaving  the  HCA  at  two  dif- 
ferent hidden  edges  at  exactly  the  critical  angle,  and  for  which  all  paths  merge  before  the  goal.  A  way  to  check 
for  this  behavior  is  to  see  if  an  optimal  path  from  a  vertex  of  one  of  the  edges  includes  a  vertex  of  the  other 
edge.  Lemma  V-4.3  states  the  analytic  fonn  of  tliis  type  of  boundary,  which  is  a  line  segment.  The  boundaries 
labeled  c  in  Figures  23,  24,  and  25  are  hidden-edge  merging-patli  boundaries.  A  hidden-edge  diverging-path 
boundary  is  like  the  preceding  except  the  two  classes  of  paths  merge  only  at  the  goal.  This  type  of  boundary 
is  also  a  line  segment,  as  stated  in  Lemma  V-4.4.  Examples  of  this  type  of  boundary  occur  in  Figures  24  and 
25  and  are  labeled  d. 

Each  pair  of  adjacent  edges  is  always  associated  with  one  of  the  above  interior  boundaries,  while 
non-adjacent  edges  may  or  may  not  be.  If  shortcutting  does  not  occur  across  an  HCA  comer,  a  boundary  will 
start  at  the  vertex  at  that  comer.  If  shortcutting  does  occur,  the  boundary  associated  with  that  vertex  will  in- 
tersect the  HCA  edge  at  the  point  where  shortcutting  starts  (see  Figure  23  where  two  of  the  boundaries  labeled 
b  intersect  the  opposite  edge.  Figure  24  where  one  of  the  boundaries  labeled  b  intersects  the  lower  right  edge 
of  the  HCA,  and  Lemma  V-4.5).  From  the  vertex  or  shortcutting  point  at  which  such  a  boundary  begins,  it  will 
continue  into  the  HCA  interior  untU  it  intersects  another  boundary  or  HCA  edge.  At  the  point  at  wliich  two 
such  boundaries  first  intersect  they  wUl  terminate,  and  a  third  boundary  will  begin  which  represents  the  division 
between  the  two  regions  which  the  first  two  boundaries  did  not  have  in  common.  For  example,  in  Figure  23 
the  boundary  associated  with  vertex  Vi  distinguishes  paths  which  cross  edge  V1V2  from  those  which  travel 
along  edge  V1V5,  while  the  boundary  associated  with  vertex  V5  distinguishes  those  which  travel  along  edge 
V1V5  from  those  wliich  travel  along  edge  V4V5  piissing  tlirough  vertex  V5.  These  two  boundaries  begin  at 
their  respective  vertices  and  intersect  in  llie  HCA  interior,  and  from  that  point  a  third  boundary  begins  which 
distinguishes  paths  which  cross  edge  V1V2  from  those  which  travel  along  edge  V4V5  passing  through  vertex 
V5.  These  two  descriptions  ("crossing  V1V2"  and  "travelling  along  V4V5  through  V5")  represent  the  two 
regions  wliich  the  initial  boundaries  did  not  have  in  common,  so  they  characterize  the  third  boundary'.  Boun- 
daries will  continue  to  intersect  and  new  ones  begin  in  the  HCA  interior  until  tlie  boundary  associated  with 
each  visible  vertex  is  joined  witli  one  or  more  hidden  vertices  or  HCA  edges  (Lemmas  V-4.10  and  V-4.11). 
These  networks  of  boundaries  can  be  represented  as  trees,  where  each  boundary-  is  considered  a  node,  and 
edges  connect  nodes  whose  boundiuies  intersect  (see  Lemma  V-4.10).  Such  a  tree,  called  an  intenor-boiwd- 
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ary  tree,  has  interior  nodes  with  exactly  two  children,  while  the  root  of  such  a  tree  can  have  zero,  two,  or  four 
cliildren.  A  tree  whose  root  and  sole  node  has  zero  cliildren  represents  a  boundary  which  goes  from  one  edge 
of  the  HCA  to  another  without  intersecting  any  other  boundaries,  such  as  the  boundary  emanating  from  ver- 
tex V2  in  Figure  23.  A  boundary  separates  two  regions,  and  any  time  two  boundaries  intersect  it  must  be,  as 
explained  above,  that  they  have  one  of  the  two  regions  in  common.  Beyond  the  point  of  intersection,  the  two 
regions  they  did  not  have  in  common  must  be  separated  by  a  boundary.  Thus  each  lime  two  boundaries  inter- 
sect, a  third  must  begin.  We  choose  as  leaf  nodes  those  boundaries  associated  with  HCA  vertices,  because  one 
of  these  boundaries  is  guaranteed  to  exist  for  each  vertex,  and  no  olfjer  interior  boundaries  intersect  it  at  tlie 
vertex  or  edge,  so  we  can  be  sure  that  tl)ey  will  have  no  children.  At  tlie  other  end  of  such  a  boundary  it  eillier 
intersects  an  HCA  edge,  meaning  its  node  is  a  root  without  children  as  described  above,  or  it  intersects  two 
other  boundaries,  one  of  which  will  also  be  associated  with  an  HCA  vertex  and  so  be  another  leaf  node.  If  the 
latter  is  true,  the  boundary  begituining  at  the  intersection  point  of  the  two  leaf-  node  boundaries  will  serve  as 
the  parent  node  of  the  two  boundaries.  This  merging  of  boundaries  will  continue  until  the  parent  node's  bound- 
ary intersects  an  HCA  edge,  in  which  case  the  node  is  the  tree's  root,  or  until  roots  of  two  boundary  trees  are 
found  to  represent  the  same  boundary,  in  wliich  case  the  two  trees  can  be  merged  into  one.  This  is  the  case 
where  a  root  will  have  four  children,  representing  the  two  boundaries  which  intersect  each  end  of  the  root's 
boundary.  Several  examples  and  illustrations  of  the  construction  of  such  interior-boundary  trees  are  given  in 
Chapter  VI. 

Outside  the  HCA,  there  are  four  types  of  boundaries  Again,  HCA  edges  are  trivial  boundaries 
(Lemma  V-4.5).  HCA  shadows  are  defined  exactly  as  for  obstacles  (Lemma  V-4.6).  Examples  of  HCA  shadow 
boundaries  are  labeled  e  in  Figures  23,  24,  and  25.  The  other  two  types  are  HCA  opposite-edge  boundaries 
and  HCA  corner-culling  boundaries.  HCA  opposite-edge  boundaries  are  the  generalization  of  obstacle  op- 
posite-edge boundaries,  and  differentiate  between  paths  which  start  outside  the  HCA  and  go  through  or  around 
the  HCA  in  different  directions.  There  are  three  types  of  opposite-edge  boundaries,  depending  on  whether 
neither,  one,  or  both  optimal  paths  go  througli  an  HCA  edge.  A  path  which  does  not  go  through  tlie  HCA  goes 
around  it  initially  via  one  of  its  vertices.  The  case  where  neitlier  path  goes  tluough  the  HCA  is  the  same  as  tlie 
obstacle  opposite-edge  boundary  case,  and  is  described  by  connected  hyperbola  segments.  The  first  ;uid  second 
cases  have  more  complicated  analytic  fonns.  although  llic  shape  of  the  boundaries  is  ver>  similar  to  hypcr- 
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bolas.  (Lemma  V-4.7).  In  Figures  23,  24,  and  25,  opposite-edge  boundaries  are  labeled  f.  In  Figures  23  and 
24  alJ  Ihxee  cases  occur,  while  in  Figure  25  Ihe  HCA  is  a  virtual  obstacle,  that  is,  it  appears  to  points  outside 
it  that  it  is  an  obstacle,  so  the  only  opposite-edge  boundary  it  has  is  the  third,  or  hyperbolic  case. 

HCA  Comer-cutling  boundaries  occur  when  optimal  paths  cut  into  the  HCA  along  an  edge  which 
is  not  part  of  the  opposite-edge  sequence.  In  fact,  the  analytic  form  of  this  boundary  is  just  a  variation  of  the 
second  of  the  three  types  of  opposite-edge  boundaries  discussed  in  the  previous  paragraph.  Comer-cutling 
boundaries  emanate  from  a  vertex  connecting  a  hidden  and  a  visible  edge  when  shortcutting  occurs  across 
tliose  edges  (for  example,  in  Figure  24,  labeled  g).  In  the  generalization  of  this  case  where  the  edges  across 
wliich  shortcutting  occurs  are  separated  by  one  or  more  edges,  the  comer-cutling  boundary  begins  at  tlie  point 
at  which  the  set  of  interior  boundaries  intersects  the  liidden  edge  (Lemma  V-4.8). 

The  construction  of  interior-boundary  trees  is  useful  in  finding  exterior  boundaries.  There  is  ex- 
actly one  opposite-edge  or  comer-cutting  boundary  associated  with  each  interior  tree  of  boundaries,  and  each 
visible  HCA  vertex  is  connected,  either  directly  or  via  its  interior  boundary  tree,  to  an  opposite-edge  or  comer- 
cutting  boundary.  (Lemma  V-4. 1 1 ).  When  an  interior  boundary  tree  includes  as  a  leaf  node  an  interior  hidden- 
edge-diverging-path  boundary,  the  point  at  wliich  the  boundary  intersects  the  HCA  edge  is  connected  with  an 
exterior  opposite-edge  boundary.  When  an  interior-boundary  tree  includes  as  a  leaf  node  a  point  of  intersec- 
tion of  an  interior  boundary  and  an  HCA  edge,  but  does  not  include  an  opposite  point,  for  example,  as  hap- 
pens three  limes  along  the  hidden  edge  of  the  HCA  in  Figure  23,  this  point  of  intersection  is  connected  witli 
an  exterior  opposite-edge  or  comer-cutting  boundary.  When  as  happens  to  the  rightmost  vertex  in  Figure  24, 
a  vertex  is  not  connected  witli  any  interior  boundary  tree,  comer  shortcutting  occurs  and  a  comer-cutling  bound- 
ary is  connected  with  the  comer  vertex.  Two  HCA  opposite-edge  boundaries  or  comer-cutting  boundaries  may 
intersect  each  oilier  or  a  shadow  boundary,  and  if  they  do  a  third  boundary  begins  at  the  point  of  intersection 
and  lies  away  from  the  goal,  as  in  the  case  of  obstacle  opposite-edges. 

An  opuinal  palli  will  travel  into  a  liigh-cost  HCA  from  outside  it  only  across  an  edge  which  fomis 
an  angle  greater  than  sin" '(20c)  with  another  connected  HCA  edge  [Ref.  20].  If  none  of  the  hidden  edges  are 
associated  with  included  angles  of  less  than  20c  with  connected  visible  edges  and  the  cost  ratio  and  dimen- 
sions of  the  HCA  allow,  it  acts  exactly  as  an  obstacle  with  respect  to  aU  start-points  outside  the  HCA  Such  an 
HCA  is  called  a  virtual  obstacle.  Tlie  HCA  shown  in  Figure  25  is  a  virtual  obstacle.  If  aU  the  opposite-edge 
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and  comer-cutting  boundaries  converge  and  become  a  single  opposite-edge  boundary  away  from  the  goal,  the 
HCA  becomes,  for  all  points  beyond  the  point  of  convergence,  a  virtual  obstacle. 
b.     High-Cost  HCA  With  An  Interior  Goal 

An  HCA  containing  the  goal  point  and  with  higher  cost  than  the  surrounding  terrain  generates  a 
set  of  exterior  boundaries  similar  to  the  high-cost  exterior-goal  case,  while  the  interior  boundaries  are  reminis- 
cent of  road  boundaries.  The  similarity  to  road  boundaries  arises  because  for  start-points  inside  the  HCA,  it 
may  be  profitable  to  move  away  from  tlie  goal  point  initially  in  order  to  travel  along  an  HCA  edge  in  the  ex- 
terior, lower-cost  region,  just  as  if  there  were  a  road  segment  along  the  HCA  edge.  Figure  26  illustrates  the 
high-cost  interior-goal  case  (see  Theorem  V-5). 

We  will  define  edges  for  diis  case  with  respect  to  each  of  its  vertices,  so  that  an  edge  may  be 
defined  differently  for  each  of  its  endpoints.  Define  a  visible  edge  with  respect  to  one  of  its  vertices  V  as  an 
edge  for  which  the  optimal  path  from  V  cuts  into  the  HCA  interior  at  some  point  along  the  edge  (either  im- 
mediately from  V  or  along  the  edge  interior).  Define  a  hidden  edge  with  respect  to  V  as  an  edge  for  which  the 
optimal  path  from  V  starts  along  the  other  edge  incident  to  V,  or  for  which  no  optimal  path  from  any  point  on 
the  edge  cuts  directly  into  the  HCA  interior.  Define  an  opposite  edge  as  an  edge  which  is  a  hidden  edge  with 
respect  to  both  its  vertices.  There  are  four  types  of  interior  boundaries,  wliich  are  line  segments  and  parabola 
segments.  Each  HCA  vertex  can  generate  a  set  of  boundaries.  For  each  vertex  V,  if  the  optimal-path  from  tliat 
vertex  consists  only  of  the  goal  point,  i.e,  if  the  optimal  path  from  the  vertex  goes  directly  to  the  goal,  then 
there  are  no  interior  boundaries  associated  with  that  vertex. 

If  on  the  otlier  hand  the  optimal  path  from  HCA  vertex  V  travels  initially  along  an  HCA  edge. 
call  the  edge  along  which  the  path  travels  initially  E2,  and  call  the  other  HCA  edge  incident  upon  V  (along 
which  the  path  does  not  travel)  Ei.  In  this  case  there  will  be  a  boundary'  associated  with  vertex  V  which  is  a 
line  segment.  This  boundary  starts  at  V  and  separates  paths  which  cut  over  to  edge  Ei  and  go  through  V  from 
those  which  cut  over  to  edge  E2,  bypassing  V.  This  is  a  hidden-edge  boundary  as  defined  for  the  exterior-goal 
case  above.  (In  Figure  26,  boundaries  labelled  a  are  hidden-edge  boundaries.  Also  see  Lemma  V-5.1  in  Ap- 
pendix A).  In  this  case  there  will  also  be  a  parabolic  boundary  called  a  hidden-edge/goal  boundary,  which 
separates  optimal  paths  which  go  directly  to  llic  go;\l  from  (hose  which  go  initially  away  from  the  goal  to  edge 
El  and  from  tlierc  through  V  and  on  around  the  HCA,  cutting  back  in  to  the  goal  al  Luiothcr  point  on  the  HCA 
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High-Cost,  Inlerior-GoaJ  HCA 
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perinieler.  Tliis  parabola  is  formed  by  considering  the  goal  point  as  the  focus,  and  constructing  the  directrix 
such  llial  it  is  perpendicular  to  a  line  from  V  into  tlie  HCA  exterior  which  forms  an  angle  of  7C/2  +  0c  with 
edge  Ei ,  and  such  that  it  is  a  distance  d  from  V  where  d  =  cost(optinial  path  from  V)/c  i ,  where  c  i  =  exterior 
cost.  (See  the  boundaries  in  Figure  26  labeled  b,  and  Lemma  V-5.2,  Appendix  A.) 

If  in  addition,  the  first  turn  point  P  on  the  optimal  path  from  V  is  an  interior  point  of  edge  E2, 
i.e.,  if  the  second  leg  of  llie  optimal  patli  from  V  cuts  into  llie  HCA  to  the  goal,  there  will  be  a  boundary  called 
a  visible-edge/goal  boundary  associated  witli  V  and  edge  E2  which  separates  paths  that  go  directly  to  the  goal 
from  those  which  go  initially  back  to  E2  then  travel  along  E2  to  P,  and  then  cut  into  the  HCA  at  P  to  tlie  goal. 
The  visible-edge/goal  boundary  intersects  the  HCA  edge  at  P.  Again,  the  focus  is  the  goal  point,  and  in  this 
case  llie  directrix  is  perpendicular  to  a  line  from  P  into  the  HCA  exterior  which  forms  an  angle  with  line  seg- 
ment PV  of  7l/2  +  9c,  and  which  is  distance  d  from  P  such  that  d  =  cost(OPL(P))/c  i .  (See  Figure  26,  the  boun- 
daries labeled  c,  and  Lemma  V-5.3.) 

The  other  type  of  interior  boundary  occurs  when  two  adjacent  vertices  on  a  hidden  edge  have 
optimal  paths  which  botli  lie  initially  on  an  HCA  edge,  but  which  go  in  opposite  directions  around  the  HCA 
(i.e.,  for  which  neither  optimal  path  includes  the  other  vertex).  This  is  the  same  situation  that  occurs  in  the 
definition  of  an  obstacle  opposite-edge,  and  so  such  an  edge  is  called  an  HCA  opposite  edge.  However,  there 
may  be  zero,  one,  or  more  opposite  edges  in  this  case.  Each  HCA  opposite  edge  V1V2  generates  an  interior 
opposite-edge  boundaiy,  which  separates  paths  which  exit  the  HCA  and  go  through  vertex  Vi  from  those 
which  exit  and  go  through  vertex  V2 .  (See  Figure  26,  the  boundary  labeled  c,  and  Lemma  V-5.4.) 

The  exterior  boundaries  in  this  case  are  quite  similar  to  the  high-cost  exterior-goal  HCA  case. 
Tliere  are  five  types  of  exterior  boundaries.  HCA  edges  are  trivial  boundaries  (Lenuna  V-5.5).  Shadow  boun- 
daries are  associated  with  each  vertex  V  whose  optimal  path  OPL(V)  includes  as  its  first  path- vertex  a  point 
P  on  the  HCA  perimeter.  The  shadow  boundary  is  constructed  by  extending  a  ray  from  V  along  line  VP  away 
from  P.  (See  Figure  26,  boundaries  labeled  e.  and  Lemma  V-5.6.) 

Opposite-edge  boundaries  emanate  from  each  HCA  opposite  edge.  An  opposite-edge  boundary 
begins  at  an  opposite  point  with  a  hyperbola  segment  and  extends  outward  from  the  HCA.  being  fonned  ex- 
actly as  in  the  exterior-goal  case.  Since  tlierc  may  be  more  than  one  opposite  edge,  there  may  also  be  more 
than  one  opposite-edge  boundar>'.  (Sec  Figure  26.  boundaries  labeled  f  and  Lemma  V-.S.7. )  Visiblc-edgc  boun- 
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daries  separate  paths  wliich  cross  two  edges  en  route  to  the  goal.  This  type  of  boundary  exists  whenever  an 
optimal  path  froni  an  HCA  vertex  goes  directly  to  the  goal.  The  boundary  starts  at  the  vertex  and  lies  outward, 
possibly  terminating  wlien  it  intersects  the  next  kind  of  boundary.  (See  boundary  labeled  g  in  Figure  26,  and 
Lemma  V-5.8.)  Coinei -cutting  boundaries  emanate  from  points  at  wliich  hidden-edge/goal  boundaries  from 
tlie  interior  intersect  tlie  HCA  edge.  They  separate  points  whose  optimal  paths  cross  tlie  edge  from  lliose  which 
go  around  the  edge  vertex.  These  boundaries  begin  at  the  HCA  edge  and  are  concatenated  witli  new  curve  seg- 
ments at  each  point  at  which  the  earlier  curve  intersects  a  shadow  boundary,  as  in  the  comer-cutting  case  above. 
(See  boundaries  labeled  h  in  Figure  26,  and  Lenmia  V-5.9.) 

c.  Low-Cost  HCA  With  An  Interior  Goal 

Analysis  of  an  HCA  with  lower  cost  than  the  surrounding  terrain,  where  tlie  goal  is  in  the  HCA 
interior,  shows  a  much  simpler  set  of  boundaries  (Theorem  V-6).  There  will  never  be  any  boundaries  inside 
the  HCA  ill  tliis  case,  because  there  is  no  incentive  for  an  optimal  patli  to  move  away  from  the  goal  to  the  high- 
cost,  external  terrain,  and  there  are  no  terrain-feature  edges  or  vertices  between  any  point  in  the  HCA  and  the 
goal,  since  our  HCA's  are  assumed  convex.  (See  Lemma  V-6.1,  Appendix  A.)  External  boundaries  will  occur 
in  pairs,  forming  a  wedge  emanating  from  each  vertex  of  the  HCA,  much  as  in  the  case  of  road-end/road  travell- 
ing boundaries  for  a  road  segment.  The  external  boundaries  are  all  rays  which  begin  at  an  HCA  vertex  and  lie 
away  from  the  goal,  and  can  be  constructed  by  tracing  a  path  from  the  goal  to  the  vertex,  and  then  employing 
SneU's  Law  for  the  path  with  respect  to  each  of  the  edges  incident  to  the  vertex  to  determine  the  orientation 
of  the  two  boundaries.  Call  this  type  of  boundary  a  vertexl edge-crossing  boundary  (see  Lemma  V-6.2).  Figure 
27  shows  a  low-cost  HCA  with  interior  goal,  and  the  boundaries  it  induces  on  the  plane. 

d.  Low-Cost  HCA  With  An  Exterior  Goal 

Tlie  final  case,  where  tlie  cost  inside  the  HCA  is  lower  than  the  surrounding  terrain  and  the  goal 
is  outside  the  HCA,  bears  some  similarities  to  the  low-cost,  interior-goal  case  and  some  to  the  high-cost,  inte- 
rior-goal case.  In  this  case,  parabolic  and  similar  boundaries  occur  outside  the  HCA,  treating  HCA  edges  as 
if  they  were  roads,  and  the  wedges  wliich  occur  in  the  low-cost,  interior-goal  case  are  present  in  this  case  as 
well.  Only  one  type  of  boundar,'  occurs  in  the  HCA  interior,  and  seven  types  occur  in  the  HCA  exterior 
(Tlieorem  V-7).  Figure  28  illustrates  a  typical  low-cost,  exterior-goal  HCA. 
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In  tlie  exterior,  in  addition  to  the  trivial  edge-  boundaries  (Lemma  V-7. 1),  boundaries  can  be  con- 
structed by  considering  the  behavior  of  the  optimal  path  from  each  of  the  HCA  vertices.  For  each  vertex  V  of 
the  HCA,  let  Ei  and  E2  be  the  edges  incident  upon  V,  while  Vi  and  V2  are  the  vertices  such  that  Wi  =  Ei 
and  W2  =  E2  .  Additionally,  let  vertex  Vi  be  closer  to  the  goal  than  vertex  V2,  i.e.,  the  cost  of  the  optimal 
path  from  Vi  be  less  than  the  cost  of  the  optimal  path  from  V2. 

If  llie  optimal  path  from  V  goes  initially  along  HCA  edge  Ei,  (note  that  it  will  not  go  along  E2 
because  of  the  naming  convention  above),  the  paths  treat  the  edge  somewhat  as  if  it  were  a  road.  Let  P  be  the 
first  point  on  the  optimal  path  from  V,  which  will  be  the  point  at  which  the  path  exits  the  HCA  interior  toward 
the  goal.  A  vertexl edge-following  boundary  and  a  xertexledge-crossing  boundary  are  associated  with  from  V 
with  respect  to  edges  Ei  and  E2  respectively.  Tlie  vertex/edge-crossing  boundary  is  a  ray  with  vertex  V  lying 
in  the  HCA  exterior  such  that  the  ray  and  the  first  leg  of  the  optimal  path  from  V  form  a  SneU  's-Law  crossing 
of  HCA  edge  E2  (see  Lemma  V-7.2).  This  type  of  boundary  separates  paths  wliich  go  to  vertex  V  and  then 
along  edge  Ei  from  those  that  go  directly  to  Ei  and  follow  along  it.  The  vertex/edge-foUowing  boundary  is  a 
special  case  of  the  vertex/edge-crossing  boundary  where  the  Snell's-Law  angle  of  the  ray  with  edge  E|  is  the 
critical  angle  0c  (see  Lemma  V-7. 3).  These  boundaries  are  labeled  1  in  Figure  28.  The  vertex/edge-crossing 
boundary  separates  paths  which  go  to  a  vertex  V  and  then  cut  into  the  HCA  interior  from  those  that  cross  edge 
El  into  tlie  interior.  In  Figure  28,  these  boundaries  are  labeled  2. 

Also  occurring  is  an  edge-following/ goal  boundary  which  is  a  parabola  with  the  goal  point  as 
focus  and  directrix  perpendicular  to  a  line  from  P  at  an  angle  7l/2  +  0c,  lying  a  distance  d  away  from  P  where 
d  is  the  cost  of  an  optijnal  path  from  P.  This  type  of  boundary  separates  paths  which  go  to  edge  E|  and  follow 
the  edge  from  those  which  go  directly  to  the  goal.  (See  Lemma  V-7.4)  Figure  28  has  these  r>'pe  of  boundaries 
labeled  4.  AddilionaUy,  a  vertex/goal  boundary  occurs  which  is  similar  to  tlie  road-end/goal  boundary  of  the 
road  segment  case.  This  boundary  begins  at  the  point  at  wliich  the  edge-foUowing/goal  boundary  intersects 
the  vertex/edge-following  boundar>',  and  is  a  hyperbola  segment  with  V  and  G  being  the  foci,  and  the  hyper- 
bolic constant  being  the  cost  of  the  optimal  path  from  V  (see  Lemma  V-7. 5).  Figure  28  labels  this  type  of 
boundarj'  3.  Tliis  boundary  may  continue  indefinitely,  or  it  may  intersect  the  vertex/edge-crossing  boundarj' 
emanating  from  V.  If  these  two  intersect,  botli  terminate  at  the  point  of  intersection  and  a  third  boundary  dis- 
cussed below  begins. 
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For  each  HCA  vertex  V  for  which  the  optinnd  path  from  V  goes  initially  into  llie  HCA  interior, 
a  pair  of  linear  vertex/edge-crossiiig  boundaries  will  occur,  just  as  in  the  interior-goal,  low-cost  case.  These 
boundaries  separate  points  whose  optimal  patlis  enter  the  HCA  through  a  hidden  vertex  from  those  which  enter 
through  a  hidden  edge.  Each  boundary  is  constructed  by  extending  a  ray  from  V  into  the  HCA  exterior  such 
that  the  ray  and  tlie  first  leg  of  the  optimal  path  from  V  fonn  a  Snell's-Law  crossing  of  Ei  and  E2  respective- 
ly. If  in  addition  tlie  vertex/goal  boundary  associated  with  vertex  V|  intersects  the  vertex/edge-crossing  bound- 
ary emanating  from  Vi  associatedwitliedgeEi,athirdboundary  begins.  If  the  first  point  P  along  tlie  optimal 
path  from  V  is  an  HCA  vertex,  the  boundary  will  be  an  edge-following/goal  boundary,  a  parabola,  as  discussed 
above.  If  P  is  an  interior  point  of  an  HCA  edge,  the  boundary  will  a  more  general  type  of  curve  similar  in  shape 
to  a  parabola,  called  an  edge-crossing/goal  boundary  (see  Lemma  V-7.6)  In  Figure  28,  these  type  of  boun- 
daries are  labeled  5.  A  vertex/goal  boundary  also  occurs,  beginning  at  the  point  at  which  the  edge-crossing/goal 
boundary  intersects  the  vertex/edge-crossing  (or  edge-following)  boundary  associated  with  edge  Ei  , 
Whenever  an  interior  boundary  (see  below)  intersects  a  hidden  edge  of  the  HCA,  an  exterior  boundary  begins, 
called  an  opposite-edge  boundary  (see  Lemma  V-7.8  and  Figure  28  boundary  labeled  7).  Opposite-edge  boun- 
daries separate  paths  which  cross  an  edge  into  the  HCA  interior  and  then  go  across  the  HCA  to  exit  across  a 
second,  visible  edge,  from  those  which  cross  the  same  first  edge  into  the  HCA  but  exit  across  a  third,  visible 
edge.  Just  as  in  the  high-cost,  exterior-goal  case,  these  boundaries  may  intersect  and  new  opposite-edge  boun- 
daries begin,  but  in  this  case  they  are  of  only  one  type  and  separate  paths  which  cross  one  pair  of  edges  from 
those  which  cross  another  pair. 

There  is  only  one  type  of  boundary'  in  the  interior  of  a  low-cost,  exterior-goal  HCA.  It  begins  at 
a  visible  vertex  wliich  is  not  directly  connected  to  any  other  boundaries,  and  separates  points  whose  optimal 
paths  cross  one  visible  edge  incident  to  the  vertex  from  those  which  cross  the  other  visible  edge.  Because  of 
its  similar  boundary  type  in  the  high-cost  exterior-goal  case,  it  is  called  a  visible-edge  boundaiy  (see  Lemma 
V-7.7  and  the  boundary  labeled  6  in  Figure  28).  Just  as  in  that  case,  the  interior  boundaries  may  intersect  and 
generate  new  boundaries,  which  are  also  visible-edge  boundaries.  Whenever  a  visible-edge  boundary  inter- 
sects a  hidden  edge,  the  visible-edge  boundary  tenninates  and  an  opposite-edge  boundaiy  begins  in  the  HCA 
exterior.  Both  the  visible-edge  boundar)'  and  the  opposite-edge  boundary  types  are  similar  in  shape  to  hyper- 
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bola  segments,  although  their  algebraic  fonn  is  not  expressible  in  closed  form.  These  boundaries  typically 
have  very  little  curvature. 

B.    A  UNIFYING  VIEW  OF  REGION  BOUNDARIES 

Tl)e  boundaries  associated  with  each  terrain  feature  and  tlie  homogeneous-behavior  regions  they  separate 
can  be  viewed  in  a  more  unified  manner.  This  view  will  provide  the  basis  for  a  key  step  in  the  algorithm 
presented  in  Chapter  VI  which  merges  optimal-path  maps  for  isolated  terrain  features  into  consolidated  op- 
timal-path maps. 

1.     Cost  Functions  of  Regions  With  Respect  to  Region  Roots 

The  cost  of  optimal  paths  from  each  start  point  in  llie  plane  is  a  function  of  the  location  of  the  start 
point.  In  other  words,  there  is  a  cost  fiinction  of  X  and  Y  which  characterizes  the  entire  map.  Consider  tlie 
region  in  tlie  vicinity  of  the  goal,  for  wliicli  the  goal  is  the  region  root.  Cost  is  proportional  to  distance  from 
the  goal,  in  the  absence  of  intervening  terrain,  so  iso-cost  contours  fomi  circles  about  llie  goal.  This  cost  func- 
tion is  an  inverted  cone  with  vertex  at  tlie  goal-point,  or  the  upper  half  of  a  cone  as  defined  in  classical  geometry . 
In  any  homogeneous-behavior  region  witli  a  point  as  its  root,  there  will  be  some  additional  cost  of  tlie  optimal 
path  from  the  root  to  the  goal.  For  each  region  whose  root  is  a  single  point  then,  the  cost  function  in  the  region 
will  be  conical  with  respect  to  a  vertical  axis  through  the  point.  The  vertex  of  the  cone  representing  the  cost 
function  wUl  be  shifted  upward  on  the  cost  axis  by  the  amount  of  the  cost  of  an  optijiial  path  from  tlie  root. 

Another  type  of  region  root  is  an  edge  along  which  paths  travel  en  route  to  the  goal,  for  example,  a 
road  segment  (see  Figure  29).  In  the  discussion  above  regarding  road  segments,  it  was  noted  that  the  path  from 
a  point  whose  optimal  path  enters  a  road  to  travel  along  it  does  so  at  the  critical  angle  9c  =  sin"  (Cr/Cb), 
where  Cr  is  the  cost  of  travelling  a  unit  distance  by  road  and  Cb  is  the  cost  of  travelling  a  unit  distance  in  back- 
ground terrain.  Also,  therefore,  the  cost  of  travelling  from  the  point  of  entrance  onto  the  road  Pe  to  the  point 
of  exit  from  the  road  Px  is  CrlPePxl  =  Cbsin(0c)IPEPxl. 

The  cost  oftravelling  from  points  to  the  road  and  along  the  road  to  the  point  of  exit  Px  is  then  ISPe'Cb 
+  IPEPxICbsinl  0c )  =  CbdSPel  +  IPnVxIsinf  6c)).  Consider  a  right  triangle  witli  hypotenuse  PePx.  w'ith  one  leg 
a  continuation  of  SPe  to  the  other  side  of  tlie  road  from  S  to  point  Q.  Now  IPeQI  =  IPEPxIsixK  0h),  so  tlie  cost 
oftravelling  from  S  to  Pe  and  along  tlie  road  to  Px  is  CbdSPEl  +  IPeQI  )  =  CblSQI  since  S.  Pe,  and  Q  are  colinear. 
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Cost  =  C, 


Cost  =  Cj- 


Figuie  29 
Cost  Function  for  Road  Segment 
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Tlius,  the  cost  from  any  point  S  to  move  to  a  road  and  travel  along  it  to  some  point  Px  is  proportional  to  the 
distance  from  S  to  a  line  at  angle  0c  vvith  the  road  and  passing  Ihrougli  Px-  But  by  this  description,  S  describes 
a  plane  which  intersects  line  QPx  lying  in  the  plane  of  the  map,  such  that  the  slope  of  the  plane  in  the  gradient 
direction  is  CblSQI/ISQI  =  Cb.  So  the  cost  function  associated  with  a  length- wise-travelled  edge  is  a  plane. 

A  third  type  of  region  root  is  an  edge  which  paths  cross,  obeying  Snell  's  Law  as  they  do  so.  As  each 
path  crosses  the  edge,  it  enters  a  region  where  the  cost  function  becomes  proportionally  greater  or  less  than 
before.  But  each  edge  wliich  is  crossed  according  to  Snell 's  Law  perfonns  a  transformation  on  the  current  cost 
function,  or  intuitively  speaking,  distorts  the  cost  function.  The  cost  function  associated  with  a  Snell 's-Law 
edge  is  therefore  a  distortion  of  the  cost  function  associated  with  the  parent  of  the  edge  in  the  optimal-path 
tree.  Thus  there  are  two  cost  functions  associated  with  Snell's-Law  edges,  one  where  the  cone  of  a  point-type 
root  is  transformed  by  the  edge  resulting  in  a  distorted  cone,  and  one  where  the  plane  of  a  road-type  root  is 
transformed  by  the  edge,  resulting  in  a  plane.  For  regions  with  conical  cost  functions,  paths  which  crossed  into 
it  from  a  region  with  a  lower  cost  would  have  a  cost  function  which  was  a  flattened  "cone".  Paths  crossing  into 
it  from  a  region  with  a  higher  cost  would  have  a  cost  function  which  was  a  "cone"  with  greater  curvature.  For 
regions  with  planar  cost  functions,  higher-cost  adjacent  regions  would  have  a  more  sloped  cost  function,  while 
lower-cost  adjacent  regions  would  have  a  less  sloped  cost  function. 

There  are  any  number  of  "higher-order"  cost  functions  associated  with  Snell's-Law  edges  ending  in 
a  point.  For  example,  paths  could  cross  three  edges  enroute  to  a  point.  So  it  does  not  appear  to  be  possible  to 
derive  a  finite  number  of  analytic  characterizations  of  cost  functions  for  all  varieties  of  Snell's-Law  edges. 
Note,  however,  that  altiiough  a  cost  function  may  be  transformed  by  any  number  of  Snell's-Law  edges,  it  has 
its  basis  in  eitlier  a  point  or  a  hnearly-traversed  edge  root,  so  there  are  really  only  two  general  classiQcations 
of  Snell's-Law  cost  functions,  those  for  n  crossings  rooted  in  a  point,  and  those  for  n  crossings  rooted  in  a 
linearly-traversed  edge.  Once  a  sequence  of  region  roots  leads  back  to  a  point  or  a  traversed  edge,  a  fixed  cost 
is  associated  with  the  point  or  the  goal  end  of  the  edge,  which  is  the  cost  from  that  point  to  the  goal,  and  so  no 
other  previous  information  about  cost  functions  remains  relevant. 

A  river  edge  can  also  be  a  region  root.  However,  since  a  river  edge  only  adds  a  fixed  amount  to  the 
cost  of  pallis  wliich  cross  it.  it  serves  only  to  shift  vertically  by  a  fixed  amount  whatever  cost  function  occurs 
in  the  region  on  its  near  side,  and  so  cannot  be  said  to  have  a  characteristic  cost  function  of  its  own.  The  final 
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type  of  region  root  is  the  degenerate  one,  the  null  list,  adopted  by  convention  to  represent  regions  wliich  have 
no  feasible  paths,  for  example,  obstacle  interior.  Since  tiie  cost  of  a  path  in  the  degenerate  region  is  infinity, 
the  cost  function  will  be  considered  undefined. 

Since  these  are  the  only  types  of  region  roots  which  occur  in  the  terrain  defined  for  this  research, 
there  are  only  three  general  types  of  cost  functions:  cones,  planes,  and  various  orders  of  distorted  cones,  depend- 
ing respectively  on  wliether  the  region  has  a  point  as  its  root,  a  linearly-traversed-edge  or  one  or  more  Snell's- 
Law  edges  ending  in  a  linearly-traversed  edge  as  its  root,  or  finally  a  SneU's-Law  edge  as  its  root  leading  to 
one  or  more  Snell's-Law  edges  and  a  point. 

2.     Boundaries  Between  Regions  as  Intersections  of  Cost  Functions 

The  occurrence  of  many  of  the  simpler  types  of  boundaries  can  now  be  explained  in  terms  of  the  cost 
functions  of  the  region  roots  for  regions  which  the  boundary  separates.  Since  at  a  boundary  between  two 
regions,  the  cost  fimction  for  both  regions  applies,  it  must  be  that  the  boundary  is  the  projection  on  the  XY 
plane  of  tlie  intersection  of  the  two  cost  functions.  The  intersection  of  two  cones  with  parallel  axes  is,  accord- 
ing to  basic  analytic  geometry,  a  hyperbola,  and  so  it  becomes  clear  why  the  boundary  between  two  regions 
witli  points  as  roots  is  always  a  hyperbola. 

The  boundary  between  a  region  whose  root  is  a  point  and  a  region  whose  root  is  a  road-segment  was 
determined  in  Section  A3  above  to  be  a  parabola.  Since  the  slope  of  the  plane  which  is  the  cost  function  of  the 
road-segment's  region  was  shown  above  to  be  the  cost  rate  of  the  background,  and  the  slope  of  the  cone  is  also 
the  cost  rate  of  the  background,  we  have  tlte  condition  which  specifies  in  intersecting  a  plane  with  a  cone  that 
the  intersection  is  a  piU"abola. 

The  intersection  of  two  planes  is  a  line,  so  the  boundary  between  regions  which  both  have  linearly- 
traversed  edges  as  roots  is  a  line  segment.  For  example,  the  hidden-edge  merging-path  boundary  of  a  high- 
cost,  external-goal  HCA  is  such  a  boundary,  and  as  shown  in  Section  A4a  above  is  indeed  a  line  segment. 

The  more  complicated  boundaries  involving  one  or  more  Snell's-Law  edges  ending  in  a  point  also 
are  consistent  with  this  view,  although  the  mathematics  involved  in  computing  the  intersections  of  general- 
ized shapes  is  complex.  Boundaries  involving  Snell's-Law  edges  ending  in  a  linearly-traversed  edge  are  of  the 
same  types  as  those  involving  single  linearly-traversed  edges.  Since  there  are  three  general  types  of  cost  func- 
tions, and  each  boundary  can  be  described  as  the  intersection  of  two  cost  functions,  there  are  six  non-redun- 


104 


dant  ways  that  two  cost  functions  may  intersect,  as  in  Table  5.  Each  entry  in  the  last  row  and  the  last  column 
depends  on  the  number  of  edges  crossed  by  the  region  root,  and  will  be  different  for  different  numbers  of 
edges.  For  some  cases,  a  boundary  listed  as  a  parabola,  hyperbola,  or  distorted  parabola  or  hyperbola  will 
degenerate  to  a  straight  line. 

A  view  which  takes  into  account  the  nature  of  the  cost  functions  associated  with  regions  which  are 
separated  by  boundaries  leads  to  a  more  unified  approach  to  the  derivation  of  the  analytical  forms  of  the  boun- 
daries. This  view  will  become  important  in  the  process  of  merging  several  single-feature  optimal-path  maps 
discussed  in  Chapter  VI,  since  there  will  be  too  many  possible  cases  of  region  intersections  to  derive  each 
analytical  form  case  by  case.  The  above  six  forms  will  provide  the  basis  for  a  general  solution  to  the  problem 
of  merging  0PM 's. 
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TABLE  5 
BOUNDARY  TYPES  BY  REGION  ROOT  PAIRS 


Region  Root  Type  (cost  functioD  type) 


poiiil 
(cone) 

linearly-traversed  edge 
(plane) 

S-L  edge  to  pt 
(distorted  cone) 


point 
(cone) 


hyperbola 

parabola 

distorted 
hyperbola 


linearly-traversed  edge 
(plane) 

parabola 


line 


distorted 
parabola 


(distorted  cone) 

distorted 
hyi>erbola 

distorted 
parabola 

distorted 
hyperbola 
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VI.  ALGORITHMS  FOR  OPM  CONSTRUCTION  BASED  ON  SPATIAL 

REASONING 

A.  OPTIMAL-PATH  TREE  CONSTRUCTION 

The  first  step  in  constructing  an  optimal-path  map  is  to  build  an  optimal-path  tree  (OPT).  A  straightfor- 
ward way  to  do  this  is  presented  here,  although  a  more  efficient  way  would  be  to  build  the  OPT  during  the  ex- 
ecution of  an  algorithm  such  as  recursive-wedge  decomposition  or  the  continuous-Dijkstra  algorithm.  A  set 
of  optimal  paths  from  tl)e  goal  point  to  each  terrain-feature  vertex  is  computed  using  any  point-to-point  path- 
planning  algorithm.  The  turn  points  of  these  optimal  paths  are  then  sequentially  inserted  into  the  OPT  by  scan- 
ning each  path  list  from  the  goal  point  to  its  start  point  as  the  OPT  is  traversed  from  its  root  (the  goal)  through 
its  internal  nodes,  matching  nodes  of  the  tree  with  turn  points  of  the  path. 

As  the  insertion  algorithm  traverses  tl)e  OPT,  a  pointer  identifies  the  current  node.  A  pointer  also  iden- 
tifies the  current  element  of  the  path  list.  If  the  current  node  has  a  child  node  which  matches  the  current  ele- 
ment of  the  path  list,  the  child  node  becomes  the  current  node  and  the  next  element  on  the  path  list  becomes 
the  current  one.  If  the  current  node  has  no  child  node  which  matches  the  current  path-list  element,  a  new  node 
is  created  which  matches  the  path-list  element  and  whose  parent  is  the  current  node.  Then  as  before,  the  child 
node  becomes  the  current  node  and  the  next  path-list  element  becomes  the  current  one.  When  the  end  of  the 
path  list  is  reached,  the  insertion  is  complete.  When  all  the  terrain-feature-vertex  optimal  paths  have  been  in- 
serted into  the  OPT,  one  final  node  representing  the  empty  path  list  (for  "start"  points  with  no  feasible  paths, 
as  for  example  in  the  middle  of  an  obstacle)  is  inserted  as  a  child  of  the  root  node  and  the  initial  OPT  is  com- 
plete. 

B.  BASIC  ALGORITHMS  FOR  ISOLATED  TERRAIN  FEATURES 

First,  we  present  algorithms  to  construct  planar  partitions  for  four  types  of  isolated  single  terrain  features, 
given  optimal-path  trees.  The  planar  partition,  along  with  its  optimal-patli  tree,  comprises  an  optimal-path  map. 
An  algoritlim  is  presented  for  obstacle,  river  segment,  and  road  segment  primitives,  and  for  each  of  the  four 
cases  associated  with  homogeneous-cost  areas  (HCA). 
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1.     An  Algorithm  for  OPM  Construction  for  A  Single  Obstacle 

For  a  single  obstacle  in  a  homogeneous-cost  background  (see  Figure  17),  the  algorithm  to  construct 
the  optimal-path  map  with  respect  to  a  certain  goal  point,  given  the  optimal-patli  tree,  is  straightforward.  The 
OPT  for  a  single  obstacle  will  have  three  branches  from  the  root,  one  of  which  will  consist  only  of  the  empty 
node.  Each  of  the  other  two  branches  will  consist  of  one  chain  of  nodes  representing  vertices  on  one  side  or 
the  other  of  the  obstacle.  The  algorithm  begins  by  taking  the  obstacle  edges  as  the  starting  set  of  homogeneous- 
behavior  boundaries.  Tlien  it  constructs  all  tlie  shadow  boundaries  by  traversing  down  tlie  two  branches  of  the 
optimal-path  tree  whose  nodes  represent  vertices  on  opposite  sides  of  the  obstacle,  creating  a  shadow  bound- 
ary for  each  edge  of  the  tree  until  it  finds  tlie  leaf  node  of  each  branch.  Then  it  constructs  the  opposite-edge 
boundary  starting  with  the  hyperbola  generated  by  the  two  vertices  of  tlie  opposite  edge  and  sweeping  away 
from  the  goal.  Each  time  the  current  segment  of  tiie  opposite-edge  boundary  intersects  a  shadow  boundary,  a 
new  pair  of  foci  is  determined,  and  the  new  hyperbola  segment  is  constructed.  The  algorithm  is  finished  when 
the  opposite-edge  boundary  does  not  intersect  any  more  shadow  boundaries. 

Table  6  (on  two  pages)  shows  the  algorithm  for  construction  of  a  single  obstacle  OPM.  Algorithms 
are  presented  using  standard  procedural  conventions  as  in  Chapter  III,  with  natural-language  explanations  sub- 
stituting for  rigorous  notation  where  possible  without  ambiguity.  The  input  to  each  algorithm  is  a  representation 
of  the  terrain  feature  and  an  optimal-path  tree,  representing  the  optimal  paths  from  each  terrain-feature  ver- 
tex. The  doubly-connected-edge-list  (DCEL)  data  structure  presented  in  Chapter  11,  Section  A  is  used  to  rep- 
resent the  planar  partition.  We  assume  that  low-level  algorithms  are  available  to  manipulate  the  DCEL,  for 
example,  insert-into-dcel.  Assume  also  that  specifying  an  optimal-path  tree  node  is  equivalent  to  specifying 
the  coordinates  of  the  vertex  represented  by  it,  as  well  as  the  cost  of  the  optimal  path  from  the  vertex  to  the 
goal. 

Tlie  procedure  add-obstacle-opposite-edge-bdr y  is  called  by  the  algorithm  to  construct  the  opposite- 
edge  boundary  as  it  lies  outward  froin  the  obstacle.  It  does  this  by  finding,  if  they  exist,  points  of  intersection 
with  the  shadow  boundaries  from  the  two  vertices  which  serve  as  the  foci  of  the  hyperbola  which  is  the  active 
portion  of  the  opposite-edge  boundar>',  and  choosing  the  one  which  occurs  closest  to  the  obstacle.  Both  the 
shadow  boundary  and  the  hyperbola  are  truncated  at  this  point,  and  new  foci  and  a  new  hyj^rbola  are  deter- 
mined. This  hyperbola  becomes  tlie  active  portion  of  the  opposite-edge  boundary,  and  new  shadow  boundaries 
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TABLE  6 
OBSTACLE  OPM  ALGORITHM 


algoritlvni  single-obstacle-opm: 

input:  Optimal-Path  Tree  with  root  node  N 

and  associated  obstacle  edge-list  O; 
output:  Optimal-Path  Map  M  (a  DCEL) 

and  modified  Oplimal-Patli  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single  obstacle; 

( 

M  :=  empty  dcel  structure: 

wliile  (O  is  not  empty) 

I 

insert-into-dceKM.First  edge  of  O); 

O  :=  O  less  first  edge  of  O; 

) 
Nprev  :=  N; 
j:=l; 
for  each  child-node  of  N 

1 

Ncurr  :=  child-node(N); 

if  Ncurr  has  a  child  node 

{ 

until  Ncurr  has  no  child  nodes 

{ 

Nprcv  :=  Ncurr! 

Bdr>'  :=  Line  NcurrNprev 

less  ray  NcurrNprev ; 
insert-into-dcel(,M,Bdry); 

} 

Opposite-edge-vertexj  :=  Ncurr ; 


(Algorithm  VI-1) 


/*  insert  obstacle  edges  into  DCEL.  */ 


/*  initialize  Nprev  to  Goal.  */ 

/*  construct  shadow  boundaries.  */ 

/*  ie,  if  node  is  not  a  leaf  node.  */ 

/*  ie,  if  node  is  a  region  root.  */ 

/*  traverse  to  bottom  of  this  branch.  */ 

/*  ie,  ray  starting  at  Ncurr  and  */ 

/*  lying  away  from  Nprev.  */ 

/*  add  shadow  boundary  to  DCEL.  */ 

/*  note:  lliere  are  exactly  two  such  vertices.  */ 


forj  :=  1  to2 

I 

Focu.Sj  :=  Opposite-edge-vertexj; 
Co.stj  :=  cost  of  optimal  path  from 
Opposite-edge-vertexj; 

I 
add-obst-opp-edge-bdry 

(Focus  1  ,Cost  I  ,Focus2,Cost2,M,N); 


/*  construct  opp-edge  bdr>'.  */ 

/*  end  of  single-obstacle-opm  Algorithm  */ 
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TABLE  6  (CONTINUED) 
OBSTACLE  OPM  ALGORITHM 


procedure  add-obstacle-opposite-edge-boundary 

input:  coordinates  and  optimal  costs  from  opposite-edge 

vertices,  shadow  bdrys  represented  in  DCEL  M,  and  optimal-path  tree  N; 
output:  revised  DCEL  M: 
purpose:  to  build  the  opposite-edge  bdry  by  concatenating  successive  hyperbola  segments; 

{ 

ShadBdryi  :=  shadow  bdry  from  Vertex i; 

ShadBdr>'2  :=  shadow  bdry  from  Vertex2; 

repeal  until  neither  shadow  boundary  intersects  the  hyperbola; 

{ 

Bdry  :=  segment  of  hyperbola  branch  such  that         /*  initialize  Bdry  to  initial  leg  starting  at  */ 

Focus  I  ;=  Vertex).  Focus2  :=  Vertexz,  /*  obstacle  opposite-edge.  */ 

hyperbolic  constant  :=  abs(Costi  -  Cost2), 

and  segment  lies  away  from  goal: 
Intersect!  :=  point  of  intersection  of  Bdry 

with  shadow  bdry  from  Focus  i ; 
Intersect2  :=  point  of  intersection  of  Bdry 

with  shadow  bdry  from  Focus2: 
if  at  least  one  shadow  bdry  intersects  Bdry  — 

I 

j  :=  j  which  minimizes  length  from  the  beginning 

of  Bdry  to  Intersectj ; 
Bdry  :=  portion  of  Bdt)'  between  its  beginning 

and  Intersect  j : 
insert-into-dcel(M,Bdry);  /*  add  current  segment  of  opp-e.  bdry  to  DCEL.  */ 

Bdry  :=  segment  of  hyperbola  branch  starting       /*  get  next  segment  of  opposite-edge  bdry.  */ 

at  Intersectj  such  that  Focusj  :=  parent-node(Focusj), 

Costj  =  Cost  of  Focusj,  hyperbolic  constant 

:=  abs{Costi  -  Cost2),  and  segment  lies  away  from  goal; 

ShadBdryj  :=  shadow  bdry  from  Verlexj;  /*  substitute  new  shadow  bdry  from  new  focus.  */ 

) 
else  inser(-iiilo-dcel(M,Bdr)');  /*  add  last  segment  of  opp-edge  bdry  to  DCEL  */ 


} 


/*  end  of  add-obstacle-opp-edge-boundary  */ 
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are  checked  for  intersections.  When  no  intersections  are  found,  the  procedure  is  finished  and  the  opposite-edge 
boundary  is  the  concatenation  of  all  the  hyperbola  segments. 

The  algorithm  of  Mitchell  [Ref.  4]  also  builds  an  optimal-path  map  for  an  obstacle.  It  allows  for  mul- 
tiple obstacles,  as  does  Algorithm  VI- 1  used  in  conjunction  with  Algorithm  VI-9  below,  and  also  depends  on 
the  analytical  characterization  of  homogeneous-behavior  boundaries  as  line  segments  or  sequences  of  con- 
nected hyperbola  segments.  His  algorithm  uses  the  notion  of  generalized  visibility  to  build  successive  sub- 
OPMs.  It  merges  OPMs  using  Voronoi-diagram  construction  methods  from  computational  geometry,  while 
algorithm  VI-9  must  use  a  more  ad  hoc  approach,  since  Voronoi  diagrams  for  the  more  general  terrain  fea- 
tures we  consider  are  not  available. 

2.  An  Algorithm  for  OPM  Construction  for  A  Single  River  Segment 

The  algorithm  to  construct  the  planar  partition  for  a  single  river  segment  is  similarly  straightforward 
(see  Rgure  18).  In  this  case,  exactly  two  shadow  boundaries,  at  most  two  river-crossing  boundaries  and  one 
opposite-edge  boundary  need  to  be  constructed.  If  the  river-crossing  boundaries  intersect,  the  opposite-edge 
boundary  will  begin  at  their  point  of  intersection.  Otherwise,  no  opposite-edge  boundary  will  exist  A  change 
from  the  obstacle  algorithm  is  the  addition  to  the  optimal-path  tree  of  edges  which  are  crossed  by  paths,  since 
these  are  homogeneous-behavior  region  roots.  Table  7  shows  the  river-OPM  construction  algorithm. 

As  discussed  in  Chapter  I,  it  is  possible  to  model  rivers,  as  well  as  obstacles  and  roads,  as 
homogeneous-cost  areas,  and  so  Algorithms  VI-4  and  VI-6  could  be  used  instead  of  Algorithms  VI- 1,  Vl-2, 
and  VI-3.  But  these  first  three  algorithms  are  simpler. 

3.  An  Algorithm  for  OPM  Construction  for  A  Single  Road  Segment 

The  algorithm  for  a  single  road  segment  is  somewhat  more  complicated,  although  still  straightfor- 
ward (see  Table  8).  As  discussed  in  Chapter  V  (see  Figures  19, 20,  and  21),  the  boundaries  which  will  exist 
for  a  road  segment  are  determined  by  the  positioning  of  the  characteristic  wedge  with  respect  to  the  road  ver- 
tices. Therefore,  top-level  decision  logic  for  the  algorithm  is  based  on  the  position  of  the  characteristic  wedge. 
Procedure  construct-rd-bdry  is  called  to  compute  each  specific  boundary. 

4.  An  Algorithm  for  A  Single  Convex  High*Cost  Exterior-Goal  Homogeneous-Cost  Area 

The  algorithm  to  compute  the  planar  partition  for  high-cost  area  with  an  external  goal  is  called  hca- 
opm-high-ext  (see  Table  9).  The  equations  for  each  boundary  can  be  found  in  Appendix  A  in  the  Lemma  cor- 
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TABLE  7 
RIVER-SEGMENT  OPM  ALGORITHM 


/*  construct  shadow  boundaries  */ 

/*  ie,  half-line  starting  at  Ncurr,  away  from  goal  */ 
/*  add  shadow  boundary  to  DCEL.  */ 


algorithm  single-river-segment-opm  (Algorithm  VI-Z) 

input:  Optimal-Path  Tree  with  root  node  N  and  associated  river  edge-Ust  R  with  cost  Cr; 
output:  Optimal-Path  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single  isolated  river  segment; 

{ 

M  :=  empty  dcel  structure; 

for  Ncurr  :=  each  river- vertex  child-node  of  N 

( 

Bdry  :=  Line  NcurrN  less  Half-line  NcurrN; 

insert-into-dcel(M3dry); 

) 
forj:=l  to  2 

{ 

Focusj  :=  River- Vertexj; 

Costj  :=  cost  of  optimal  path  from  River- Vertexj; 

Bdryj  :=  segment  of  hyperbola  branch  with  foci 

Focusj  and  Goal,  hyp  constant  =  abs(Costj  -  Cr), 

such  that  branch  is  closer  to  Focusj; 
if  Bdryj  intersects  river  segment 

Intersect]  :=  intersection  point; 
else 

Bdryj  :=  null  list; 

I 
if  Bdry  1  is  not  null 

{ 

Intersect  1,2  :=  intersection  of  Bdry  i  and  Bdry2 ; 

Bdry  I  :=  Bdryi  from  Interseai  to  Intersect  1,2 ; 

Bdry2  :=  Bdry2  from  Intersea2  to  Intersect  1,2 ; 

insert-ijato-dcel(M,Bdry  I ); 

insert-into-dceKM3dry2); 

Bdry  :=  segment  of  hyperbola  branch  with 

Focus  I  and  Focus2,  hyperbolic  constant  = 

abs(Costi  -  Cost2),  such  that  branch  is  closer 

to  the  higher-cost  focus,  with  starting  point  at 

Intersect  1, 2,  lying  away  fix)m  goal; 
River-edge  1 ,2  :=  Line  bom  Intersect  1  to  Intersect2 ; 
insert-into-opt(N4Uver-edgei,2); 

) 
else 

Bdry  :=  segment  of  hyperbola  branch  with 

Focus  I  and  Focus2,  hyperbolic  constant  = 

abs(Costi  -  Cost2),  such  that  branch  is  closer 

to  the  higher-cost  focus,  with  starting  point  at 

intersection  of  hyp  and  river,  lying  away  from  goal; 
insert '•iiito-dcd(M,Line  fix)m  Focus  1  to  Focusz);         /*  add  river  edge  as  bdry  */ 
iiisert-into-dcdKM3dry);  /*  add  opposite-edge  bdry  to  DCEL  */ 

)  /*  end  of  single-river-opm  Algorithm  */ 


/*  river-crossing  bdry  for  each  river  vertex.  */ 

/*  if  so.  And  intersection  point  */ 

/*  if  not,  river-crossing  bdry  does  not  exist.  ♦/ 
/*  (neither  bdry  or  both  bdrys  will  be  null)  */ 


/*  add  river-crossing  bdry  1  to  DCEL.  */ 
/*  add  river-crossing  bdry  2  to  DCEL.  */ 
/*  flrxl  o[^osite-edge  bdry.  ♦/ 


/♦  add  river-crossing  edge  to  Optimal-Path  Tree.  */ 


/*  find  opp-edge  bdry  if  no  river-crossing  bdrys.  */ 
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TABLE  8 
ROAD-SEGMENT  OPM  ALGORITHM 


algorithm  single-road-segment-op  m  (Algorithm  VI-3) 

ii^ut:  Optimal-Path  Tree  with  root  node  N  «ind  associated  road  edge-list  R  with  cost  Cr; 
output:  Optimal-Patli  Map  M  (a  DCEL)  and  modified  Optimal-Patli  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single,  isolated  road  segment; 

I 

M  :=  empty  dcel  structure; 

9c  :=  sin'  '(Cr/Cbackground);  /*  Toad  critical  angle  */ 

Wedge-Ray  1  :=  ray  from  G  intersecting  road  V1V2 

at  Pt  A  such  that  ZGAV2  =71/2  -  Oc; 
Wedge-Rayi  :=  ray  from  G  intersecting  road  V1V2 

at  Pt  B  such  that  ZGBVi  =  7C/2  -  0c;  /*  A  is  oriented  to  B  as  Vi  is  to  V2  (see  Chap  V)*/ 

if  pts  A,  B,  and  Vi  are  ordered  "BAVi"  /*  wedge  is  "inside"  Vi  so  generate  boundary  */ 

{ 

constnict-rd-bdry(road-end/travel]ing,Vi);  /*  types  b,c  and  d  on  the  Vi  end.  ♦/ 

construct-rd-bdry(road-end/goal,Vi); 
constnict-rd-bdry(near-side-road-lravelling/goal,V|); 

if  pts  A3,  &  V2  are  not  ordered  "V2AB"  /*  if  in  addition  wedge  is  not  "outside"  V2,  */ 

constnict-rd-bdry(road-travelling/crossing,Vi);  /*  generate  type  e  bdry  on  Vj  end.  */ 

) 

else  if  they  are  ordered  "BViA"  /*  wedge  "straddles"  Vi  so  generate  boundary  */ 

construct-rd-bdry(road-shadow,Vi);  /*  type  g  on  the  V|  end  */ 

else  if  they  are  ordered  "ViBA"  /*  wedge  is  "outside"  Vi  so  generate  boundary  */ 

I 

constnict-rd-bdry(near-side-rd-traveirg/goal,V2);  /*  types  d  on  the  V2  end  and  f  on  the  Vi  end*/ 

construct-rd-bdry(far-side-road-lravelling/goal,V2); 

) 
if  pts  A,  B,  and  V2  are  ordered  "ABV2"  /*  wedge  is  "inside"  V2  so  generate  boundary  */ 

( 

constnict-rd-bdry(road-end/traveUing,V2);  /*  types  b,c  and  d  on  the  V2  end.  */ 

construct-rd-bdry(road-end/goal,V2); 
construct-rd-bdry(near-side-road-travelling/goal,V2); 

if  pts  A3,  &  Vi  are  not  ordered  "ViBA"  /*  if  in  addition  wedge  is  not  "outside"  Vi,  */ 

construct-rd-bdry(road-travelling/crossing,V2);  /*  generate  type  e  bdry  on  V2  end.  */ 

I 

else  if  they  are  ordered  "AV2B"  /*  wedge  "straddles"  V2  so  generate  boundary  */ 

con8tnict-rd-bdry(road-shadow,V2);  /*  type  g  on  the  V2  end.  */ 

else  if  they  are  ordered  "V2AB"  /♦  wedge  is  "outside"  V2  so  generate  boundary  */ 

{ 

constnict-rd-bdry(near-side-rd-travell'g/goal,V2);  /*  types  d  on  the  Vi  end  and  f  on  the  V2  end.  */ 

constnict-rd-bdry(f ar-side-road-travelling/goal ,  Vi ); 

I 
)  /*  end  of  single-road-opm  algorithm  */ 
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TABLE  8  (CONTINUED) 
ROAD-SEGMENT  0PM  ALGORITHM 


procedure  constmct-rd-bdry 

;    input:  type  of  bdry  T,  vertex  V  of  road,  DCEL  M,  Optimal-Path-Tree  N,  and  Wedge-Ray  i  and  Wedge-Rayi 
output:  revised  DCEL  M  and  revised  OPT  N; 
purpose:  construct  each  road-generated  boundary  of  type  T; 

(j  :=3-i;  /*  if  i=l,  j=2  arxlif  i=2,  j=l,i.e.,  jis  otherend  */ 

if  T  =  road-endAravelling  /*  Type  "b"  boundary  */ 

{ Bdry  1  :=  Ray  with  vertex  Vi,  lying  on  line  VjX,  such  that  ZVjViX  =  n/2+Oc; 

Bdry2  :=  Ray  with  vertex  Vi,  lying  on  line  VjY,  such  that  ZVjViY  =  37C/2-0c; 

insert -into-dcel(M3dry  I );  /*  add  road-end/travelling  boundary  to  DCEL.  */ 

insert-into-dcel(M3dry2);  /*  add  road-eud/travelling  boundary  to  DCEL.  */ 

} 
else  if  T  =  road-end/goal  /*  Type  "c"  boundary  */ 

{ Bdry  :=  the  branch  closer  to  Vi  of  a  hyperbola  with  foci  Vi  and  Goal,  and  hyp.  constant  =  cost  from 

Vi  to  Goal  via  road,  starting  at  point  of  intersection  between  hyperbola  and  type  b  bdry  from  Vi; 
insert'into-dceKM3dry);  /*  add  road-end/goal  boundary  to  DCEL.  */ 

) 
else  if  T  =  near-side-road-travelling/goal  /*  Type  "d"  boundary  */ 

{ if  (wedge  is  not  outside  Vj)  /*  wedge  is  inside  Vi  &  not  outside  Vj  */ 

Bdry  :=  segment  of  parab.  s.t.  focus  =  Goal,  and  directrix  DXWedge-Rayj  with  D  being  IGPI  from  P 
(P=A  if  i=l,  else  P=B),  starts  at  P,  Ues  away  from  Goal,  ends  at  inters,  with  type  b  bdry  from  Vi; 
else  /*  wedge  is  inside  Vi  &  outside  Vj  */ 

Bdry  :=  segment  of  parabola  with  focus  =  Goal  and  directrix  =  line  L,  LXWedge-Rayj  such  that  L  is 
IGVjl  from  Vj,  starting  at  P  :=  Vj,  lying  away  from  Goal,  ending  at  inters,  with  type  b  bdry  from  Vi; 
insert-into-dcel(M3dry);  /*  add  near-side-road-trvlg/goal  bdry  to  DCEL.  */ 

insert-into-opt  (N,PViJNear-side);  /*  add  travelled  road  segment  to  OPT.  */ 

ijoisert-uito-dcei(M^Vi);  /*  add  travelled  segment  as  edge  bdry  to  DCEL  */ 

) 
else  if  T  =  road-travelling/crossing  /*  Type  "e"  boundary  */ 

{ Bdry  :=  ray  starting  at  P  and  lying  along  Wedge-Rayi, 

(where  P=A  if  i=l  and  P=B  if  i=2),  lying  away  from  Goal; 
insert -into-dcel(M3dry);  /*  add  road-travelling/crossing  bdry  to  DCEL.*/ 

insert-into-opt  (N,edge  PVi  J^'ar-side);  /*  add  road  segment  which  is  travelled  to  OPT.  */ 

insert-into-dcel(M3Vi);  /*  add  travelled  segment  as  edge  bdry  to  DCEL  */ 

) 
else  if  T  =  far-side-road-lravelling/goal  /*  Type  "f '  boundary  */ 

(insert-into-opt  (N,ViVjJ^ear-side); 
insert-into-opt  (N,ViVjFar-side); 

insert-into-dcel  (MUine  ViVj);  /*  road-edge  boundary  added  to  DCEL  */ 

for!t:=lto2 

{Bdryk  :=  segment  of  parabola  with  focus  =  Goal,  and  directrix  =  line  L,  LXWedge- 

Rayic  such  that  L  is  IGVil  from  Vi,  starting  at  Vi  and  lying  away  from  Goal; 
insert-into-dcel(M3dryk);  /*  add  far-side-road-trvlg/goal  bdrys  to  DCEL.  */ 

) 
) 
else  if  T  =  road-shadow  /*  Type  "g"  boundary  */ 

{Bdry  :=  ray  from  Vi  along  line  ViG,  lying  away  from  Goal; 

insert-into-dceKM3dry);  /*  add  road-shadow  bdry  to  DCEL.  */ 

) 
)  /*  end  of  construct -rd-bdry  */ 


114 


TABLE  9 
HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 

algorithm  hca-opm-high-ext  (algorithm  VI-4) 

input:  Optimal-Path  Tree  N,  HCA  A  with  n  vertices; 

output:  DCEL  M,  aud  modified  OPT  N; 

purpose:  to  construct  the  OPM  for  a  high-cost,  exterior- goal  HCA. 

{ 

for  i  :=  1  to  n  /*  add  interior  bdry  for  each  vertex.  */ 

I 

if  edge  i  is  visible 
if  edge  i+1  is  visible 

B  :=  value  returned  by  constnict-liigh-ext-lica-bdry("visible-edge",i); 
else 

B  :=  value  returned  by  construct-liigh-ext-lica-bdry("visible-hidden",i); 
else  if  edge  i  is  hidden 
if  edge  i+1  is  visible 

B  :=  value  returned  by  construct-high-ext-hca-bdry("visible-liidden",i+l); 
else 

if  edges  are  on  different  sides  of  opposite  edge 

B  :=  value  returned  by  construct-liigh-ext-lica-bdry("hidden/diverging"4); 
else 

B  :=  value  returned  by  construct-high-ext-hca-bdryChidden/nierging",!); 
add  B  to  BdrySet; 

) 
BdrySet  :=  value  returned  by  pair-and-merge-bdrys  /*  join  interior  bdrys  together.  */ 

(BdrySet,"high-ext-hca-interior"); 
form  BdryTrees  from  bdrys  in  BdrySet; 
for  each  Bdry  Tree 

{ 

find  point  X  at  which  BdryTree  /*  there  will  be  exactly  one  X  per  tree  */ 

intersects  an  opposite  edge; 
B  :=  value  returned  by  constnict-lMgh-ext-hca-bdry("opposite-edge",X); 
add  B  to  OEBdrySet; 

) 
for  i  :=  1  to  n 

if  Vi  connects  a  visible  and  a  hidden  edge 

i 

if  Vi  is  not  connected  to  any  interior  BdryTree 

add  construct-liigh-ext-hca>bdi7("conier-cutting",X)  to  BdrySet; 
B  :=  value  returned  by  construct-high-ext-hca-bdry("shadow",i); 
j  :=  other  vertex  of  Ej 

while  Ej  is  not  an  opposite  edge  /♦  work  around  the  HCA  creating  shadow  */ 

I  /*  bdrys  until  the  opposite  edge  is  found.  */ 

B  :=  value  returned  by  coiistnict-liigh-ext-hca-bdry("shadow",j); 
j  :=  other  vertex  of  Ei 
) 
I 
B  :=  value  retun»d  by  pair-and-merge-bdrys  /*  join  opposite-edge  bdrys  together.  */ 

(OEBdrySet,"high-ext-hca-exterior"); 
add  B  to  BdrySet; 
for  all  B  e  BdrySet 

insert-into-dcei(M3); 
)  /*  end  of  hca-opm-high-ext  */ 
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TABLE  9  (CONTINUED) 
HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  pair-and-merge-bdrys  /*  join  connecting  bdrys  together.  */ 

input:  BdrySet,  and  type  of  region; 
output:  revised  BdrySet; 
puipose:  to  take  an  initial  set  of  boundaries,  pair  the  ones  which  first  intersect  each  other,  and 

propagate  a  new  bdry  from  each  intersected  pair,  continuing  until  all  appropriate  bdrys  are  joined. 

{ 

while  BdrySet  is  changing 

I 

PairedBdrySet  :=  BdrySet; 

while  PairedBdrySet  is  changing 

{ 

for  all  Bije  PairedBdrySet  where  Bi,j  is  unmarked 

I 

discard  Bi.j  from  PairedBdrySet; 

add  Bij  from  BdrySet  to  PairedBdrySet; 

intersect  B; :  with  Bh,i  and  truncate  both; 

add  Bh.i'™"*^and  Bij*™"'  to  PairedBdrySet; 

intersect  Bi,j  with  Bi.k  andtiuncate  both; 

add  Bi/""^  and  Bj,k    "^  :=  to  PairedBdrySet; 

I 
for  all  Bi,j€  PairedBdrySet 

discard  all  but  the  shortest  Bij  from  PairedBdrySet; 
unmark  all  bdrys  In  PairedBdrySet; 
for  all  Bi,j  and  Bj.kG  PairedBdrySet  such  that  Bij  adjoins  Bj,k 

mark  Bij  and  Bj,k; 

) 
for  all  Bi jand  Bj,kE  PairedBdrySet  such  that  Bij  adjoins  Bj,k 

add  Bi.k  to  PairedBdrySet; 
BdrySet  :=  PairedBdrySet; 

) 
)  /*  end  of  pair-and-merge-bdrys.  */ 


.^i^^"^- ^>*»^r^  -    ^..    ....■■  ^ 
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TABLE  9  (CONTINUED) 
HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  constnict-high-ext-hca-bdry  /*  provides  methods  to  construct  each  type  of  */ 

iiq^ut:  type  of  bdry  T;  index  of  vertex  i;  /*  bdry  of  liigh-cost,  exterior-goal  HCA.  */ 

output:  Bdry,  the  resulting  boundary; 
purpose:  to  construct  a  boundary  generated  by  vertex  i  of  type  T; 

I 

ifT  =  "visible-edge" 

Bdry  :=  curve  as  specified  in  Lemma  V-4. 1; 
if  T  =  "visible-hidden" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.2; 
if  T  =  "merging" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.3; 
ifT  =  "diverging" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.4; 
ifT  =  "hca-edge" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.7; 
if  T=  "shadow" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.8; 
if  T  =  "opposite-edge" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.9; 
if  T  =  "comer-cutting" 

Bdry  :=  curve  as  specified  in  Lemma  V-4. 10; 
)  /*  end  of  construct-high-ext-hca-bdry  */ 


117 


responding  to  the  boundary  type  (see  also  Figures  23,  24,  and  25).  Each  vertex  of  such  a  HCA  is  associated 
with  an  internal  boundary,  whose  character  depends  on  whether  the  edges  incident  to  the  vertex  are  visible  or 
hidden  (and  for  vertices  on  two  hidden  edges,  on  whether  the  vertices  nearest  the  goal  for  each  edge  have  op- 
timal paths  which  go  in  the  same,  or  different  directions  around  the  HCA,  called  merging  or  diverging  paths 
respectively).  These  boundaries  are  computed  first,  aiKl  then  procedure  pair-and-merge-bdrys  constructs  a 
network  (or  networks)  of  interior  boundaries  which  is  connected  to  the  initially-computed  boundaries.  This 
procedure  pairs  boundaries  which  intersect,  and  then  plots  a  new  boundary  which  has  an  endpoint  at  the  point 
of  intersection  of  the  paired  boundaries.  It  continues  pairing  boundaries  atxl  plotting  new  ones  until  all  the 
bouixiaries  are  joined  together  on  both  ends  or  intersect  an  edge  of  the  HCA.  Note  that  deciding  which  ad- 
jacent boundaries  should  be  paired  together  is  not  simple,  atKl  it  may  take  several  iterations  for  the  procedure 
to  settle  on  a  correct  configuration. 

The  interior  boundaries  are  then  joined  into  trees,  and  since  each  interior  boundary  tree  intersects  an 
opposite  edge  exactly  once,  this  can  serve  to  begin  generation  of  the  external  opposite-edge  boundaries.  In 
contrast  to  obstacles,  there  can  be  several  HCA  opposite  edges  and  opposite-edge  bouiKlaries.  Comer-cutting 
boundaries  are  indicated  when  an  interior  boundary  associated  with  a  vertex  actually  begins,  not  at  the  vertex, 
but  somewhere  along  the  boundary.  The  algorithm  next  checks  for  this  situation,  which  can  only  happen  with 
respect  to  a  vertex  joining  a  hidden  and  a  visible  edge.  This  type  of  vertex  is  also  a  good  place  to  begin  generat- 
ing shadow  boundaries.  Bnally,  procedure  pair-and-merge-bdrys  is  again  used,  this  dme  with  the  exterior 
shadow  and  opposite-edge  boundaries. 

Figures  30, 3 1,  and  32  illustrate  the  state  of  procedure  pair-and-merge-bdrys  at  various  intermediate 
stages  in  its  execution  for  the  example  HCAs  of  Rgures  23, 24,  and  25  respectively.  Edges  of  the  HCAs  are 
numbered,  and  boundaries  are  labeled  "i,j",  where  i  and  j  represent  the  edges  crossed  by  paths  on  either  side 
of  the  boundary.  Boundaries  which  are  paired  with  another  boundary  at  each  stage  are  noted  by  an  asterisk. 
Boundaries  which  are  stored  in  the  data  structure  PaiiedBdrySet  are  noted  in  the  figures  as  dark  lines.  Hgure 
30a,  3  la,  and  32a  show  the  interior  boundaries  associated  with  each  terrain-feature  vertex  at  the  beginning  of 
the  algorithm  (beginning  at  the  vertex  or  associated  short-cutting  point,  extending  indefinitely  into  the  inte- 
rior and  then  beyond.  The  current  set  of  interior-boundary  trees  is  also  shown,  with  each  node  labeled  by  the 
boundary  it  represents. 
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Figure  30 
Construction  of  HCA  Interior-Boundary  Tree  Example  1 
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Figure  31a 
Construction  of  HCA  Interior-Boundary  Tree  Example  2 
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Figure  31b 
Construction  of  HCA  Interior-Boundary  Tree  Example  2 
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Figure  32 
Construction  of  HCA  Interior-Boundary  Tree  Example  3 
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Consider,  for  example,  Figure  31.  Figure  31b  shows  the  state  of  PairedBdrySet  with  respect  to  the 
HCA  after  the  first  pass  through  the  inner  loop  ("while  PairedBdrySet  is  changing"),  where  each  boundary 
"i,j"  in  the  initial  set  of  boundaries  is  intersected  with  the  two  adjacent  boundaries,  and  the  shortest  version  of 
"i  j"  is  retained  in  PairedBdrySet.  Those  boundaries  which  pair  up  with  an  adjacent  boundary  are  marked  with 
"*".  In  Figure  31b,  "1,6"  pairs  with  "5,6"  and  "1,2"  pairs  with  "2,3".  "4,5"  and  "3,4"  were  not  marked,  and  so 
are  going  to  be  replaced  in  PairedBdrySet  by  the  full  versions  of  their  respective  boundaries  at  the  start  of  tlie 
next  pass  through  the  inner  loop.  After  the  second  pass  through  the  inner  loop,  all  boundaries  are  marked  as 
in  Hgure  3  Ic,  so  on  the  next  iteration  no  changes  to  PairedBdrySet  will  be  made,  so  the  "while  changing"  con- 
dition will  fail,  ending  the  inner  loop. 

As  the  outer  loop  ("while  BdrySet  is  changing")  finishes  its  first  pass,  new  boundaries  are  generated 
fi^om  each  intersection  point  of  paired  boundaries,  and  these  boundaries  are  placed,  unmarked,  into  Paired- 
BdrySet, which  replaces  BdrySet.  This  situation  is  reflected  in  Figure  3  Id.  Figure  31e  reflects  the  state  of 
PairedBdrySet  after  the  outer  loop  has  started  its  second  pass,  and  the  inner  loop  has  run  until  it  stabilizes 
again.  Note  that  some  boundaries  which  were  paired  after  pass  one,  i.e.,  "4,5"  and  "3,4",  are  in  fact  intersected 
by  second-level  boundaries  instead,  and  so  the  truncated  versions  of  the  boundaries  need  to  be  retracted  fi^om 
PairedBdrySet  and  the  full  versions  put  back  into  PairedBdrySet  for  further  interaction  with  second-level  boun- 
daries. This  illustrates  why  such  this  procedure  is  complicated,  because  we  are  not  able  to  tell  with  a  single 
pass  which  boundaries  will  be  paired.  Boundary  "1,4"  is  now  propagated  from  both  directions  from  the  inter- 
section points  of  "4,5"  and  "1,5"  as  well  as  "1,3"  and  "3,4".  It  is  truncated  at  both  ends  and  paired  with  itself, 
alter  which  the  configuration  is  stable.  Thus  BdrySet  will  not  change  further,  so  the  outer  loop  will  halt  with 
BdrySet  as  illustrated  in  Figure  3 If.  At  each  stage,  the  interior-boundary  trees  are  built  up  until,  in  Figure  3 1  f, 
a  single  tree  results. 

In  algoritten  hca-opm-high-ext,  it  is  assumed  initially  that  there  is  an  opposite  point,  i.e.,  a  point  on 
the  hidden  side  of  the  HCA  where  two  optimal  paths  go  in  opposite  directions  around  the  HCA.  Further,  this 
assumed  opposite  point  is  initially  considered  a  vertex  for  the  purposes  of  the  algorithm.  Figure  30  shows  a 
situation  where  the  algorithm  leads  to  the  conclusion  that  the  opposite  point  does  not  exist  after  all,  and  so 
there  is  no  interior  boundary  incident  to  it,  because  there  is  shortcutting  of  paths  from  the  outside  of  the  HCA 
across  the  HCA  to  the  goal.  The  figure  also  shows  a  situation  where  there  is  more  than  one  interior-boundary 
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tree.  There  is  one  exterior  opposite-edge  boundary  incident  upon  an  HCA  edge  associated  with  each  interior- 
boundary  tree.  It  has  one  endpoint  at  the  point  at  wliich  a  boundary  of  the  tree  intersects  an  opposite  edge. 

5.     An  Algorithm  for  OPM  Construction  for  A  Single  Convex  High-Cost,  Interior-Goal 
Homogeneous-Cost  Area 

A  much  different  algorithm  is  needed  to  construct  boundaries  for  the  case  of  a  high-cost  HCA  with 
an  interior  goal  point  (see  Figure  26).  The  existence  of  interior  boundaries  are  more  predictable  without  the 
need  for  the  iterative  checking  as  in  the  high-cost,  exterior-goal  HCA  case.  It  is  still  necessary,  however,  to 
check  the  intersections  of  various  bourKlaries  and  truncate  them  appropriately,  and  insert  portions  of  edges 
into  the  optimal-path  tree,  which  is  done  at  the  algorithm's  conclusioa  (See  Table  10.) 

The  algorithm  proceeds  by  looking  at  each  HCA  vertex  in  turn,  and  determining  by  observing  its  op- 
timal path  whether  it  is  a  hidden  or  a  visible  vertex.  If  it  is  a  hidden  vertex,  the  path  from  the  vertex  will  travel 
along  an  edge  of  the  HCA  before  cutting  into  the  interior,  while  if  it  is  a  visible  vertex,  the  path  will  go  direct- 
ly to  the  goal.  If  it  is  hidden,  several  interior  boundaries  and  one  exterior  shadow  boundary  are  generated,  as 
weU  as  possibly  an  opposite-edge  boundary.  If  it  is  visible,  only  one  exterior  boundary,  a  visible-edge  bound- 
ary, is  generated. 

It  is  necessary  to  insert  portions  of  edges  into  the  optimal-path  tree  according  to  the  traversal  charac- 
teristics of  optimal  paths  across  or  along  them.  For  example,  it  is  possible  for  a  portion  of  an  edge  from  one 
vertex  to  act  like  a  road,  where  paths  leave  the  HCA  interior  to  travel  along  the  lower-cost  edge,  and  then  cut 
back  in  to  the  HCA  when  nearer  to  the  goal.  Thus  the  first  portion  of  the  edge  would  be  the  root  of  a 
homogeneous-behavior  region  characterized  by  paths  crossing  from  the  interior  to  the  exterior  and  travelling 
along  the  edge,  and  the  next  portion  of  the  edge  would  be  the  root  of  another  region  characterized  by  paths 
crossing  fr(xn  exterior  to  interior.  All  this  information  is  not  available  when  processing  each  individual  ver- 
tex, however,  so  edges  which  may  become  region  roots  are  stored  temporarily,  and  at  each  step  when  infor- 
mation is  gained  which  could  rule  out  portions  of  edges  as  roots,  that  information  is  stored  as  a  "mask",  which 
is  used  to  mask  out  portions  of  edges.  At  the  conclusion  of  the  algorithm,  these  edges  and  masks  are  processed 
to  determine  exactly  which  portions  of  edges  belong  as  region  roots  in  the  optimal-path  tree.  Also  done  at  the 
conclusion  of  the  algorithm  is  the  intersecting  of  qpposite-edge  and  shadow  boundaries  and  plotting  of  new 
boundaries  in  the  HCA  exterior,  much  like  in  the  interior  of  a  high-cost,  exterior-goal  HCA. 


124 


TABLE  10 
HIGH-COST  INTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-high-int  (algorithm  ¥1-5) 

input:  Optimal-Path  Tree  with  root  N,  HCA  A  with  u  vertices; 
output:  DCEL  M  and  revised  OPT  N; 
purpose:  construct  an  OPM  for  high-cost,  interior-goal  HCA; 
{ for  i  :=  1  to  n 

{ if  P  9t  Goal,  where  OPL(Vi)  =  [P I  OPL(P)]  /*  i.e.,  if  path  from  V  Ues  on  edge  Ei  of  HCA  ♦/ 

{  /*  with  other  edge  called  Ei ,  an  interior  linear  */ 

E2  :=  edge  containing  ViP;  /*  bdry  and  two  parabolic  bdrys  arc  formed,  */ 

El  :=  other  edge  incident  to  Vj;  /*  and  an  exterior  shadow  boundary  is  formed.  ♦/ 

B|  :=  value  returned  by  construct-high-int-hca-bdry("hidden-edge",Vi); 
B2  :=  value  returned  by  constnict-high-int-hca-bdry("hidden-edge/goal",Vi); 
B3  :=  value  returned  by  construct-high-int-hca-bdry("visible-edge/goal",P); 
B4  :=  value  returned  by  construct-high-int-hca-bdry("shadow",P); 
add  B4  to  ExtBdrySet; 

intersect  B|,  B2,  B3  &  add  B i'™"*^  to  IntBdrySet;  /*  they  intersect  at  the  same  point.  */ 
if  B2  intersects  Ei  at  some  pt  X 

{ truncate  B  2  at  X; 

add  B2'™"^  to  IntBdrySet; 

insert-into-opt(N,ViX,  "Near-side"); 

add  El  and  Mask(ViX)  to  VisEdgeSet; 

B5  :=  value  returned  by  constmct-high-int-hca-bdry("comer-cutting",X); 

add  B5  to  ExtBdrySet; 

}  /*  if  paths  from  two  vertices  go  opposite  ways  */ 

else  if  (OPL(Vi)  <r  OPL(Vi+ 1)  and  OPL(Vi+ 1 )  <Z  DPL(Vi))       /♦  around  HCA,  edge  is  opp  edge.  ♦/ 

{ B6  :=  value  returned  by  constnict-high-int-hca-bdry("interior-opposite-edge",Vi,Vi+ 1 ); 

intersect  B6  with  B2  &  add  Be*™"*"  to  IntBdrySet; 

X  :=  pt  where  B6  intersects  Ei; 

B7  :=  value  returned  by  constnict-high-int-lica-bdry("exterior-opposite-edge",Vi,Vi+i); 

add  B7  to  ExtBdrySet; 

insert-into-opt(N,ViX,"Near-side"); 

iiisert-into-opt(N,XVi+ 1 , "Near-side"); 

) 
else 

{ insert-into-opt(NJEt, "Near-side"); 

add  B2'™"''  to  IntBdrySet; 

I 
if  B3  intersects  edge  E2  at  X 

{ iiMert.into.opt(N,ViX,  "Near-side"); 

tnincate  B3  at  X; 

add  B3'™'^  to  IntBdrySet; 

} 
I 
else  /*  i.e.,  if  path  goes  from  V  directly  to  Goal.  */ 

{B  :=  value  returned  by  construct-liigh-int-hca-bdry( "visible-edge ',Vi); 
add  B  to  ExtBdrySet; 
add  El  and  E2  to  VisBdrySet; 

} 
post-process-high-int-hca-bdrys; 
)  /*  end  of  hca-opm-high-int  */ 
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TABLE  10  (CONTINUED) 
HIGH-COST  INTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  constnict-high-int-hca-bdry  /*  constructs  each  type  of  bdry  formed  by*/ 

input:  type  of  bdry  T;  P,  the  staxt-point  of  bdry;  /*  a  high-cost,  interior-goal  HCA.  */ 

output:  Bdry,  the  resulting  boundary; 

purpose:  to  construct  a  boundary  generated  from  point  P  of  type  T; 
{if  T  =  "hidden-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.1; 
if  T  =  "hidden-edge/goal"  Bdry  :=  curve  as  specified  in  Lemma  V-5.2; 
if  T  =  "visible-edge/goal"  Bdry  :=  curve  as  specified  in  Lemma  V-5.3; 
if  T  =  "interior-opposite-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.4; 
if  T  =  "hca-edge "  Bdry  :=  curve  as  specified  in  Lemma  V-5.5; 
if  T  =  "shadow"  Bdry  :=  curve  as  specified  in  Lemma  V-5.6; 
if  T  =  "exterior-opposite-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.7; 
if  T  =  "comer-cutting"  Bdry  :=  curve  as  specified  in  Lemma  V-5.8; 
if  T  =  "visible-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.9; 
)  I*  end  of  constnict-high-int-hca-bdry  */ 

procedure  post-process-high-int-hca-bdrys  /*  store  bdrys  and  edges.  */ 

ii^ut:  VisEdgeSet,  the  set  of  bdrys  from  visible  edges,  IntBdrySet,  the  set  of 

interior  bdrys,  ExtBdrySet,  the  set  of  exterior  bdrys,  and  Optimal-Path  Tree  N; 
output:  DCEL  M,  and  revised  OPT  N; 
{ for  each  edge  E  €  VisEdgeSet 

I  for  all  MaskE  E  :=  E  less  Maske; 

N  :=  value  returned  by  insert •into-opt(NJE); 

} 
for  each  bdry  B  €  IntBdrySet 

if  another  version  of  B  exists 

{ truncate  B  andB'; 

uisert-uito-dcel(M3tninc); 

I 
for  each  bdiy  B  €  ExtBdrySet 

join-high-int-bdry9(B  .ExtBdrySet); 
for  each  bdry  B  €  ExtBdrySet 

iii5ert-into-dcel(M3); 
}  /*endofpost-process-high-uit-hca-bdrys*/ 

procedure  join-high-int -bdrys  I*  joins  external  bdrys.  */ 

input:  bdry  B  i,  set  of  bdrys  ExtBdrySet; 
output:  revised  ExtBdrySet; 

purpose:  to  pair  bdrys  which  first  intersect,  and  propagate  new  ones  from  their  pt  of  intersection. 
{ for  each  B2  €  ExtBdrySet  such  that  B 1  and  B2  intersect  and  B 1  and  B2  are  adjacent 

{ truncate  B 1  and  B2; 

remove  original  B 1  and  B2  fix>m  ExtBdrySet; 

add  B  t*™"*  and  B2'™"^  to  ExtBdrySet; 

T  :=  type  of  new  bdry;  /*  based  on  edges  El  and  E2  not  */ 

B3  :=  value  returned  by  /*  conunon  to  B  i*™"^  and  62'™'^.  */ 

coiistruct-hca-opm-high-int-bdry(T,Ei,E2) 

jvin-high-int-bdry9(B33xtBdrySet);  /*  recursively  follow  bdry  outward  from  HCA.  */ 

) 
}  /*  end  of  join-high-int-bdrys.  "*/ 
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6.     An  Algorithm  for  OPM  Construction  for  A  Single  Low-Cost,  Exterior-Goal 
Homogeneous-Cost  Area 

The  exterior-goal-iow-cost-region  algorithm  shown  in  Table  1 1  looks  at  each  HCA  vertex  in  turn, 
basing  its  logic  on  the  initial  direction  of  the  optimal  path  from  the  vertex  being  examined  (see  Figure  27).  If 
the  optimal  path  from  a  vertex  goes  into  the  HCA  interior,  two  rays,  or  vertex/edge-crossing  boundaries,  are 
constructed  forming  a  wedge  outward  from  the  vertex  and  away  from  the  goal.  If  the  optimal  path  goes  along 
an  edge  of  the  HCA,  one  of  the  above  boundaries,  the  one  closer  to  the  direction  of  travel  of  the  optimal  path, 
is  instead  a  vertex/edge-following  boundary,  and  in  addition  a  parabolic,  or  vertex/goal  boundary  is  con- 
structed. The  third  possibility  is  that  the  optimal  path  goes  directly  into  the  HCA  exterior,  i.e.,  toward  the  goal. 
If  so,  more  boundaries  may  or  may  not  be  generated.  If  a  portion  of  each  edge  adjacent  to  the  vertex  is  visible 
to  the  goal,  i.e.,  if  for  both  edges  there  are  paths  starting  at  some  points  on  the  edges  which  go  directly  into  the 
HCA  exterior,  then  a  visible-edge  boundary  will  emanate  from  the  vertex  into  the  HCA  interior. 

With  the  above  boundaries  generated,  two  tasks  remain.  First,  each  parabolic,  or  edge-following/goal 
boundary  must  be  followed  away  from  the  goal  to  see  if  it  intersects  the  next  ray  boundary.  If  so,  a  hyperbohc, 
or  vertex/goal  boundary  will  begin,  with  one  focus  at  the  vertex.  This  hyperbola  must  then  be  followed  in  turn. 
If  it  intersects  a  ray  boundary,  a  "distorted-parabolic",  or  edge-crossing/goal  boundary  will  begin.  As  we  con- 
tinue to  follow  this  sequence  of  boundaries,  hyperbolas  and  distorted-parabolas  occur  alternately  until  no  in- 
tersection with  a  ray  is  found  Note  that  this  algorithm  generates  each  parabolic  and  distorted-parabolic 
boundary  in  the  initial  phase,  atxl  then  generates  hyperbolas  as  needed  in  procedure  add-hyp-bdrys-for-low- 
ext-hca  below,  which  in  addition  truncates  each  boundary  as  necessary. 

Although  this  type  of  HCA  has  interior  boundaries,  which  one  might  suppose  would  need  to  be  paired 
and  merged  as  with  the  high-cost,  exterior-goal  case,  in  fact  it  is  not  necessary  to  do  this.  The  reason  is  that 
such  boundaries  are  all  of  the  visible-edge  type,  and  because  the  HCA  interior  is  of  lower  cost  than  the  sur- 
rounding terrain,  these  bouixiaries  will  never  intersect.  Intuitively  in  the  high-cost  exterior- goal  case,  a  path 
travels  to  an  edge  further  away  in  straight-line  distance  in  order  to  take  advantage  of  the  lower  external  cost 
outside  that  edge,  and  at  that  point,  two  boundaries  would  intersect  and  a  third  emerge.  Here,  however,  the 
path  is  already  in  the  least  costly  terrain  possible,  and  so  further  paths  will  continue  to  follow  the  same  paths 
as  those  closer  to  the  goal.  For  each  visible-edge  boundary,  a  point  of  intersection  is  plotted  with  the  far  edge 
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TABLE  11 
LOW-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-low-ext  (algorithm  VI-6) 

input:  Optimal-Path  Tree  with  root  N,  and  HCA  A; 

output:  Optimal-Path  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 

purpose:  constnict  an  OPM  for  a  low-cost,  exterior-goal  HCA; 

I 

for  each  vertex  V  of  A  with  incident  edges  Ei  and  E2    /*  consider  each  vertex  and  its  adjacent  edges  */ 

such  that  E|  =  Wi  and  E2  =  VV2,  where  IV2GI  >    /*  where  Vi  is  closer  to  goal  than  V2,  and  */ 

rViGI  and  OPL(V)  =  [P I  OPL(P)] 


/*  where  P  is  the  first  point  on  V's  opt  path.  */ 
/*  if  optimal  path  from  V  goes  into  HCA  interior  */ 


/*  two  rays  are  Snell's-Law  patlis  across  */ 
/*  edges  El  and  E2  through  vertex  V  */ 

/*  add  edges  to  OPT  as  region  roots.  */ 


/*  if  opt.  path  from  V  goes  along  an  HCA  edge  ♦/ 


{ 

if  VP  lies  in  HCA  interior 

{ 
construct-low-ext-hca-bdry(vertex/ 

edge-crossing,  V,V  1 ,  V2); 
construct-Iow-ext-hca-bdry(  vertex/ 

edge-crossing,  V,V2,V  1 ); 
insert-into-opt(N,  W 1  J^ar-side); 
insert-into-opt(N,W2j'ar-side); 

) 
else  if  VP  lies  along  HCA  edge  E| 

( 
constnict-low-ext-hca-bdry(edge-folIowing/ 

goal,V,Vi,V2); 
construct-low-ext-hca-bdry(  vertex/ 

edge-following,  V,V  1  ,V2); 
construct-Iow-ext-hca-bdry(  vertex/ 

edge-crossing,  V,V2,Vi); 
insert-into-opt(N,VPJ^ear-side); 
iiMert-uito-opt(N,W2  Far-side); 

) 
else  if  ((Qi  is  in  HCA  exterior)  or  (V|Q|€  V|V))    /*if  both  edges  are  visible  or  partially  visible  */ 
and  ((Q2  is  in  HCA  exterior)  or  (V2Q2e  V2V)))  /♦  (optimal  path  from  V  lies  in  HCA  exterior).  */ 


/♦  two  rays  are  Snell's-Law  paths  across  ♦/ 
/*  edges  El  and  E2  through  vertex  V  */ 

/*  add  edges  to  OPT  as  region  roots.  */ 


where  OPL(Vi)  =  [Qi  I  OPUQi)] 
and  OPL(V2)  =  [Q2 1  OPL(()2)] 

{ 
constract-low-ext-hca-bdi7(visible-edge, 

V,Vi,V2); 
for  i  :=  1  to  2 
if(ViQie  ViV) 

insert-into-opt(N,  QiV,  Far-side); 
else  iiisert-iiito-opt(N,  V|V,  Far-side); 
) 
) 
add-hyp-bdrys-for'low-ext-hca(ParabBdrys); 

) 


/♦  Note:  Qi  are  the  first  points  on  */ 
/*  the  optimal-path  lists  of  each  Vi  */ 

/*  vis-edge  bdry  from  V  w.r.t.  Ei  and  E2  */ 


/♦  add  as  region  root  the  portion  of  */ 
/*  edge  across  which  paths  cross.  */ 


/*  end  of  algorithm  hca-opm-low-ext  */ 
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TABLE  11  (CONTINUED) 
LOW-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  add-hyp-bdrys-for-low-ext-hca;  /*  puts  hypeibolas  between  pairs  of  ray  bdrys  */ 

it^ut:  ParabBdrys,  the  set  of  parabolic  boundaries; 
output:  revised  DCEL; 
purpose:  to  concatenate  hyperbolic  bdrys  onto  parabolic  ones. 

I 

while  ParabBdrys  ^  0 

{ 

select  bdry  B  i  e  ParabBdrys  associated  with  vertex  Vj  and  edge  Ej ; 

tnincate  B  i  and  the  vertex/edge- following  or  vertex/edge-crossing  bdry  B2  emanating 

from  Vi,  and  associated  with  edge  Ej  at  the  point  where  they  intersect; 
B4  :=  value  returned  by  construct-low-  /*  bdry  is  hyperbola  intersecting  one  or  */ 

ext-hca-bdry( vertex/goal, Vi,Vj,Vk);  /*  both  rays  emanating  from  vertex  Vi  */ 

if  B4  intersects  vertex/edge-crossing  bdry 

B  3  associated  with  Vi  and  edge  Ek,  k^j, 

I 

truncate  B3  and  B4  at  their  point  of  intersection; 

tnincate  Bse  ParabBdrys  assoc.  with  Vg  and  Ek,  g^,  at  its  intersection  with  B3  and  B4 ; 

I 
remove  B 1  from  ParabBdrys; 
)  /*  end  add-hyp-bdrys-for-low-ext-hca  ♦/ 


of  the  HCA,  and  an  opposite-edge  boundary  is  generated,  which  is  really  just  a  continuation  of  the  visible- 
edge  boundary  after  crossing  another  edge. 

Procedure  construct-iow-ext-hca-bdry  performs  the  low-level  function  of  generating  each  bound- 
ary for  the  low -cost,  exterior-goal  HCA  as  needed.  For  boundaries  whose  forms  are  general  curves,  the  reader 
is  referred  to  the  appropriate  Lemma  in  Chapter  V  and  proof  in  Appendix  A. 

7.     An  Algorithm  for  OPM  Constmction  for  A  Single  Low-Cost,  Interior-Goal 
Homogeneous-Cost  Area 

Algorithm  hca-opm-low-int  is  the  simplest  of  the  four  HCA  algorithms,  in  keeping  with  the  simple 
nature  of  the  regions  and  boundaries  associated  with  this  type  of  HCA  (see  Figure  28  and  Table  12).  Since  a 
low-cost,  interior-goal  HCA  generates  only  one  wedge  of  two  rays  at  each  vertex,  and  these  rays  are  guaran- 
teed by  the  orientation  of  the  HCA  edges  not  to  interact,  the  corresponding  algorithm  can  do  its  work  in  one 
pass  through  the  Ust  of  vertices. 
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TABLE  12 
LOW-COST  INTERIOR-GOAL  HCA  0PM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-low-int 

input:  Optiinal-PathTree  with  root  N,  and  HCA  A; 
output:  Optimal-Path  Map  M  (a  DCEL)  and  modified 
purpose:  to  construct  the  0PM  for  a  low-cost,,  interior 

{ 

M  :=  empty  dcel  structure; 

for  each  edge  V  i  V2  of  A 

I 

Bdryi  :=  ray  starting  at  Vi,  lying  away 

from  Goal  G  thru  pi  Xi ,  such  that 

ZgViV2=  k/2-Qi,  ZX1V1V2  =  K/2+Q2  , 

and  cint  sinOi  =  Cext  sin  62; 
Bdry2  :=  ray  starting  at  V2,  lying  away 

from  Goal  G  thru  pt  X2,  such  tliat 

ZGV2Vi=  7C/2-01,  ZX2V2V1  =  71/2+02  , 

and  Cint  sinOi  =  Cext  sin  O2 ; 
insert-into-dcel(M,Bdry  1 ); 
insert-into-dceI(M3dry2); 
insert-into-dcel(M,V  1 V2); 
insert-iiito-opt(N,edge  ViVzJ'ar-side); 

} 
} 


(algorithm  VI-7) 

Optimal-Path  Tree  N; 
-goal  HCA; 


/*  two  bdrys  emanate  from  each  vertex,  */ 
/*  at  the  Snell's-Law  angle  with  respect  */ 
/*  to  each  edge.  */ 


/♦  add  vertex/edge-crossing  bdrys  to  DCEL.*/ 

/*  add  HCA-edge  boundary  to  DCEL  */ 
/*  add  edge  which  is  crossed  to  OPT.  */ 

/♦  end  of  hca-opm-low-int  */ 


C.    EXTENDING  THE  BASIC  ALGORITHMS  TO  MULTIPLE  CONNECTED  RIVER  AND 
ROAD  SEGMENTS 

1.     An  Algorithm  for  OPM  Construction  for  Multiple  Connected  River  Segments 

It  is  now  possible  to  build  on  a  basic  understanding  of  the  nature  of  boundaries  generated  by  single, 
isolated  river  segments  in  order  to  construct  the  boundaries  associated  with  multiple,  connected  linear  river 
segments,  or  rivers.  There  may  be  two  or  more  river  segments  emanating  from  a  single  vertex,  but  all  seg- 
ments of  a  river  must  have  the  same  crossing  cost.  It  might  be  thought  that  the  algorithm  proposed  below  to 
construct  the  optimal-path  map  for  multiple  terrain  features  could  be  used  to  construct  it  for  this  kind  of  ter- 
rain as  well.  However,  connected  river  segments  are  not  "decomposable"  into  their  constituent  segments. 
Decomposability  of  a  set  of  terrain  features  is  defined  as  follows. 
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Terrain  map  M  with  optimal-path  tree  N  is  defined  as  decomposable  for  path  planning  into  subsets 
S I  and  S2  if  both  S 1  and  S2  are  consistent  with  OPT  N.  Say  that  a  set  of  terrain  Si  which  is  a  subset 
of  a  set  of  terrain  S  is  consistent  with  an  OPT  N  constructed  for  S  if  for  an  OPT  Nj  constructed  for 
Si  considered  alone,  every  node  of  Ni  appears  in  N,  and  the  parent  of  every  node  of  Ni  appears  in 
the  path  from  the  node  to  the  root  of  N. 

In  other  words,  if  one  subset  could  not  behave  in  the  way  it  does  without  the  presence  of  the  other, 
the  terrain  is  not  decomposable.  Connected  river  segments  have  as  part  of  their  nature  that  at  internal  vertices, 
i.e.,  where  two  segments  join,  there  are  regions  where  paths  must  either  cross  a  river  or  move  away  from  the 
vertex,  while  for  the  individual  segments,  a  path  could  bypass  the  river  segment  by  simply  moving  around  the 
vertex.  Thus  a  set  of  connected  river  segments  is  not  decomposable  into  its  individual  segments. 

Two  high-level  paradigms  in  addition  to  those  used  for  single  river  segments  are  useful  here.  Fust, 
we  partially  sort  the  river  segments  according  to  their  general  visibility  to  the  goal,  i.e.,  so  that  a  segment  which 
is  fully  or  partially  occluded  by  another  follows  it  in  the  partial  order,  and  we  process  the  segments  according 
to  this  partial  order.  Thus  boundaries  which  may  affect  other  segments  are  already  in  place  by  the  time  the 
other  segments  are  considered.  Second,  whenever  a  boundary  intersects  an  occluded  segment,  an  event  point 
is  generated.  When  a  segment  is  processed,  it  is  necessary  to  consider  each  event  point  and  decide  whether  the 
boundary  which  caused  the  event  point  continues  on  the  other  side  of  the  river  segment.  Figiue  33  shows  a 
river  consisting  of  connected  river  segments,  and  Rgure  34  shows  a  worst-case  orientation  of  segments. 

Several  new  terms  must  be  defined.  General  visibility  between  two  terrain  features  is  defined  as  fol- 
lows. Two  features  Fi  and  Fn  are  generally  visible  with  respect  to  a  goal  G  if  there  is  a  sequence  of  features 
Fi,  i=l  to  n,  such  that  for  all  i,  Fi  is  visible  to  Fi+ 1.  A  feature  Fi  is  occluded  by  aiK>ther  Fj  with  respect  to  goal 
G  if  for  every  sequence  by  which  Fi  and  G  are  generally  visible,  Fj  is  a  member  of  the  sequence.  In  other  words, 
Fi  is  occluded  by  Fj  if  it  is  partially  or  completely  within  the  shadow  of  Fj  cast  by  G.  An  erxlpoint  V  of  line 
segment  Li  is  defined  as  an  exterior  vertex  if  V  is  not  an  endpoint  of  any  other  line  segment,  or  if  segment  L2 
of  wfaicfa  V  is  an  endpoint  occludes  Li.  V  is  defined  as  an  interior  vertex  if  it  is  not  an  exterior  vertex.  Intui- 
tively this  means  that  an  optimal  path  from  an  interior  vertex  must  either  cross  the  river  or  move  away  from 
the  vertex  to  get  past  the  line  segment,  while  from  an  exterior  vertex  an  q)timal  path  can  simply  move  around 
the  vertex  and  bypass  the  river.  Rgure  33  shows  the  partial  ordering  of  river  segments  as  weU  as  the  exterior 
or  interior  nature  of  each  vertex. 
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The  algorilhm  based  on  these  ideas  is  complicated  by  the  possibility  that  rivers  may  turn  back  on 
themselves  and  create  pockets  where,  for  a  high-enough  crossing  cost,  it  is  cost-effective  to  move  away  from 
the  goal  out  of  the  pockets  rather  than  cross  a  river.  This  situation  is  illustrated  in  Figure  33a,  in  the  vicinity 
of  vertices  8  through  1 1 .  A  type  of  boundary  in  addition  to  those  presented  in  Chapter  V  for  single  river  seg- 
ments is  generated  in  this  case,  although  it  is  very  similar  to  the  other  types.  Whenever  an  exterior  vertex  Vi 
is  encountered  in  the  course  of  processing  river  segments,  a  river-crossing  boundary  is  generated  for  tliat  ver- 
tex, as  explained  in  Chapter  V.  If  this  boundary  does  not  intersect  any  segment  between  V|  and  V2,  all  paths 
from  immediately  on  the  far  side  of  the  river  including  the  path  from  V2  will  go  via  V 1 .  In  this  situation  there 
will  be  a  boundary  which  separates  paths  which  cross  a  river  toward  the  goal  from  those  which  move  away 
from  the  goal  and  eventually  go  through  V2  and  then  through  V 1 .  At  each  interior  vertex,  as  well  as  at  the  next 
exterior  vertex,  a  portion  of  this  bourxiary  will  be  generated.  This  type  of  boundary  is  called  a  near-side-river- 
crossing  boundary  and  it  is  exactly  the  complement  of  the  river-crossing  boundary  which  would  be  generated 
from  that  vertex  if  an  optimal  path  from  the  vertex  lay  forward  across  the  river.  In  other  words,  it  starts  at  the 
current  river  segment  and  lies  forward  toward  the  goal. 

An  example  of  a  near-side-river-crossing  boutKiary  in  Figure  33  has  one  end-point  on  segment  (8,9). 
From  there,  it  lies  toward  the  goal  until  it  intersects  a  shadow  boundary  which  starts  at  vertex  9.  The  next  por- 
tion of  the  boundary  is  the  hyperbola  segment  whose  axis  is  the  line  between  vertices  10  and  4.  After  it  inter- 
sects the  shadow  boundary  from  vertex  10,  the  boundary  is  the  hyperbola  segment  whose  axis  is  the  line 
between  vertices  1 1  aixl  4.  Finally,  it  ends  at  the  point  where  it  intersects  a  river-crossing  boundary  separat- 
ing points  whose  paths  go  around  vertex  5  from  those  whose  paths  cross  segment  (7,8).  From  there  an  op- 
posite-edge boundary  begins,  separating  points  whose  paths  go  around  vertex  5  bom  those  which  go  around 
vertex  1 1.  A  second  example  of  a  near-side-river-  crossing  boundary  is  in  the  vicinity  of  vertex  I. 

At  each  interior  vertex  V,  the  test  for  a  near-side-river-crossing  boundary  is  as  follows.  If  for  a  point 
arbitrarily  close  to  V,  but  on  the  near  side  of  the  river,  called  V,  the  q)timal-path  list  of  V  includes  Vext.  the 
currently  active  exterior  vertex,  a  near-side-river-crossing  boundary  is  generated.  The  foci  are  V  and  the  ver- 
tex or  goal  point  X  such  that  the  cost  of  a  straight-line  path  from  V  to  X  plus  the  cost  of  the  optimal  path  from 
X  is  minimized,  and  the  hyperbolic  constant  is  the  cost  of  the  optimal  path  from  V  minus  the  sum  of  the  cost 
of  the  rivers  crossed  from  V  to  X  and  the  cost  of  the  optimal  path  from  X.  In  this  case,  the  shadow  boundary 
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from  V  may  intersect  tlie  boundary  at  a  point  P.  The  boundary  starts  at  its  intersection  witli  the  current  river 
segment,  or  if  it  is  the  second  or  subsequent  portion  of  the  boundary  to  be  generated,  at  its  intersection  with 
tlie  previous  boundary  portion,  and  ends  at  point  P.  If  the  boundary  intersects  the  river-crossing  boundary 
generated  by  Vext,  it  ends  at  that  point  and  the  Vcxt  boundary  constitutes  the  remainder  of  the  boundary. 

Shadow  boundaries  follow  the  same  specifications  as  listed  in  Chapter  V,  namely  that  a  vertex  V, 
with  an  optimal  path  which  goes  first  to  point  P,  generates  a  shadow  boundary  which  is  a  ray  starting  at  V  and 
lying  away  from  P  on  the  line  VP,  but  with  the  variation  that  it  must  be  considered  whether  the  optimal  path 
of  V  crosses  the  river  segment  or  not.  If  for  V  as  defined  above,  and  for  V*  arbitrarily  close  to  V  on  the  far 
side  of  the  river  segment,  V  can  be  positioned  so  as  to  lie  on  the  optimal  path  of  V"*",  a  normal  shadow  bound- 
ary results.  This  is  the  case  where  paths  from  the  far  side  of  the  river  may  cross  in  the  vicinity  of  V,  and  such 
a  boundary  simply  keeps  track  of  which  segment  the  paths  cross. 

If  V  includes  in  its  optimal  path  the  current  Vcxt,  it  will  be  the  case  that  V^  does  so  as  well,  and  the 
shadow  boundary  which  results  will  conform  to  the  above  specification  with  respect  to  V  and  will  have  the 
unusual  characteristic  that  it  lies  on  the  near  side  of  the  river  segment.  This  is  the  case  where  points  on  the  near 
side  of  V  are  caught  in  a  "pocket"  for  which  it  is  faster  to  move  away  from  the  goal  and  around  Vcxt  than  to 
cross  river  segments  forward  of  V.  Such  a  shadow  boundary  separates  points  which  go  to  V  and  then  to  the 
vertex  on  the  next  river  segment  from  those  which  bypass  V  and  go  to  the  next  vertex  directly. 

If  V^  includes  in  its  optimal  path  the  current  Vcxt,  but  V  does  not,  the  shadow  boundary  from  V  will 
be  formed  with  respect  to  V*",  and  lie  on  the  far  side  of  the  river.  This  is  the  case  where  the  optimal  path  of  V" 
lies  on  the  same  side  of  the  river  segment  as  does  the  optimal  path  of  Vcxt,  but  the  optimal  path  of  V*  includes 
Vext,  signifying  that  paths  on  the  far  side  of  the  river  in  the  vicinity  of  V  will  not  cross  it,  but  paths  on  the  near 
side  will  lie  generally  toward  the  goal,  not  being  caught  in  a  "pocket"  which  causes  them  to  move  away  from 
the  goal  to  avoid  crossing  subsequent  river  segments.  Table  13  shows  the  algorithm  for  construction  of  mul- 
tiple connected  river  segments. 
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TABLE  13 
MULTIPLE-CONNECTED-RIVER-SEGMENT  OPM  CONSTRUCTION 

ALGORITHM 


algorithm  multi-segment-river-opm  (algorithm  VI-S) 

input:  List  of  river  segments  R,  river-crossing  cost  Cr,  Optimal-Path  Tree  N,  Goal  G; 
output:  DCEL  M  and  revised  OPT  N; 

purpose;  construct  a  planar  partition  and  revise  tlie  OPT  for  multiple,  coruiected  river  segments; 
(partially  order  R  so  that  Si  <  Sj  iff  Si  obscures  part  of  Sj  wiUi  respect  to  G; 
for  each  segment  S  e  R  in  partial  order,  letting  S  =  V1V2  where  Vi  is  closer  to  G  than  is  V2 
{plot  shadow  bdry  from  Vi; 
plot  shadow  bdry  from  V2; 

intersect  bdrys  with  all  subsequent  segments,  noting  an  event-point  whenever  intersection  occurs; 
ifVi  is  "exterior" 
{Vexi:=Vi; 
sort  event-pts  on  V1V2  with  respect  to  Vi, 

iiKluding  V2  as  an  event-point; 
until  a  river-crossing  bdry  is  plotted  for  Vi 
or  event-list  is  empty 
{select  next  event-point  E; 
Er  :=  root  of  region  on  side  of  E  closer  to  V 1 ; 
Cv„t:=IEV«tl  +  l(VcxtG)*l; 
CEr  :=  lEErl  +  l(ErG)*l; 

ifCv«t>CEr 

plot  river-crossing  bdry  with  respect  to  Vcxt  and  Er; 
else 

delete  portion  of  bdry  Be  lying  away  from  Goal; 
} 

} 
else 

do  nothing;  /*  if  Vi  is  "interior".  */ 

if  V2  is  "interior" 

{ V2"  :=  point  arbitrarily  close  to  V2  on  same  side  of  river 

as  first  leg  of  optimal  path  from  Vext; 
V2*  :=  point  arbitrarily  close  to  V2  on  opposite  side  of  river 

as  first  leg  of  optimal  path  from  Vext; 
if  Vext  e  (V2G)*  and  Vext  e  (V2''G)* 

{plot  shadow  bdry  Bi  such  that  for  0PL(V2"G)*  =  [P I  OPL(P)], 

Bi  :=  ray  on  line  V2P  starting  at  V2,  lying  away  from  P; 
X  :=  vertex  or  goal  such  that  /*  ie,  vertex  with  best  cost  from  V2  to  X  to  Goal,  */ 

IV2XI  +  l(XG)*l  is  minimized;  /*  with  hyp  cost  :=  Ono.  rivers  crossed  by  V2X.  */ 

plot  B2  :=  near-side-crossing  bdry  with  /*  note  that  if  intersection  is  beyond  Vi,  there  is  */ 

foci  V2  and  X,  where  B2  starts  at  point  of     /*  another  r»ear-side-crossing  bdry  wliich  */ 
intersection  with  line  ViV2  and  ends  at        /*  intersects  B2.  */ 
intersection  with  B 1; 

} 
else  if  P'  =  P"^,  where  0PL(V2")  =  [P'  I  OPL(P")]  and  OPL(Vi^  =  [P*  I  OPL(P^] 

plot  shadow  bdry  on  line  V2P^  starting  at  V2  lying  away  from  P*; 
) 
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TABLE  13  (CONTINUED) 
MULTIPLE-CONNECTED-RIVER-SEGMENT  OPM  CONSTRUCTION 

ALGORITHM 

else  /*  V2  is  "exterior".  */ 

if  Vext  e  (Vro*  and  Vcxt  e  (V|*G)*  /*  if  V2  is  "hidden".  */ 

{plot  shadow  bdiy  Bi  such  that  for  OPL(VrG)*  =  [P I  OPL(P)], 

Bi  :=  ray  on  line  ViP  starting  at  Vi,  lying  away  from  P; 
X  :=  vertex  or  goal  such  that  /*  ie,  vertex  with  best  cost  from  Vi  to  X  to  Goal,  */ 

rViXI  +  l(XG)*l  is  minimized;  /*  with  hyp  cost  :=  Cr-no.  rivers  crossed  by  V2X.  */ 

plot  B2  :=  near-side-crossing  bdry  widi  /*  note  that  if  intersection  is  beyond  V2,  there  is  */ 

fod  V|  and  X,  where  B2  starts  at  point  of     /*  another  near-side-crossing  bdry  which  */ 

intersection  with  line  V1V2  aixi  ends  at        /*  will  intersect  B2.  */ 

intersection  with  B 1; 

) 
else  /*  V2  is  "visible".  */ 

|Vext:=V2; 

sort  event-pts  on  V1V2  with  respect  to  V2, 

including  V|  as  an  event-point; 
until  a  river-crossing  bdry  is  plotted  for  V2 

or  event-list  is  empty 

{ select  next  event-point  E; 

Er  :=  root  of  region  on  side  of  E  closer  to  V2; 

Cv«t:=IEV„tl  +  l(VextG)*l; 

CEr  :=  lEErl  +  KErG)*l; 

ifCVcxt>CEr 

plot  river-crossing  bdry  with  respect  to  Vcxt  and  Er; 
else 

delete  portion  of  bdry  Be  lying  away  from  Goal; 

) 
join  and  merge  bdrys  associated  with  Vi  V2,  noting  all 

intersections  with  obscured  segments  as  event-points. 
}  /*  end  of  "for  each  segment".  */ 

join  and  merge  all  bdrys; 
)  I*  end  of  algorithm  multi-segment-river-opm.  *l 


1.    OPM  Construction  of  Multiple  Connected  Road  Segments 

Unlike  connected  river  segments,  connected  road  segments  are  decomposable  into  tlieir  constituertt  seg- 
ments. The  basic  reason  for  this  is  that  road  segments  will  not  serve  to  block  or  hinder  padis,  but  only  to  operate 
as  conduits.  Therefore,  connected  road  segments  can  be  decomposed  into  individual  segments  by  algorithm 
VI-9  below,  algorithm  VI-3  used  on  each  segment,  and  the  resulting  OPM's  merged  into  a  final  OPM. 


137 


D.    A  DIYIDE-AND-CONQUER  ALGORITHM  FOR  MULTIPLE-FEATURE  OPM 
CONSTRUCTION 

A  principal  goal  of  our  research  is  to  Gntl  an  algoritlim  which  will  create  optimal-path  maps  for  multiple 
terrain  features  of  the  four  types  described  above.  Although  the  investigation  into  this  problem  is  not  complete 
in  all  its  details,  we  propose  the  following  high-level  description  of  such  an  algorithm  (see  Table  14). 

Methods  for  constructing  Voronoi  diagrams  (see  Chapter  II)  provide  a  model  for  approaches  to  the  con- 
struction of  an  optimal-path  map  for  multiple  terrain  features.  Voronoi  diagram  methods  use  a  divide-and-con- 
quer  approach,  in  which  the  points  in  the  plane  are  divided  into  two  roughly  equal  sets,  the  Voronoi  diagrams 
of  the  two  sets  computed  recursively,  and  the  two  Voronoi  diagrams  merged  to  produce  the  final  one.  The  first 
key  question  is  how  to  divide  the  points  in  the  plane.  The  answer  in  this  case  is  that  in  order  to  support  the 
merge  phase,  the  plane  is  partitioned  into  two  half-planes  by  a  line  (by  convention,  a  vertical  line)  which  equal- 
ly divides  the  set  of  points  in  the  plane.  The  other  key  question  is  whether  tlie  two  intermediate  Voronoi 
diagrams  can  be  merged.  Standard  generalized- Voronoi-diagram  construction  algorithms  provide  an  affirm- 
ative answer  to  this  question,  depending  on  the  fact  that  the  boundary  between  any  two  Voronoi  regions  in  bi- 
nary terrain  (i.e.,  obstacles  on  a  homogeneous-cost  background)  is  a  straight  line  segment  or  a  hyperbola 
segment  [Ref.  8]. 

The  analogous  questions  with  respect  to  optimal-path  map  construction  are  whether  terrain  features  can 
be  divided  in  the  same  manner  as  points,  and  how  two  optimal-path  maps  with  the  same  goal  can  be  merged 
into  a  single,  combined  OPM.  An  encouraging  aspect  of  this  problem  is  that  when  constructing  OPM's  for 
single  terrain  features,  we  rely  on  the  optimal  paths  fi^om  only  the  terrain-feature  vertices,  which  are  computed 
by  standard  point-to-point  path  planners  and  take  all  the  features  of  a  map  into  account  Thus  the  optimal  paths 
from  any  vertex  will  remain  the  same  regardless  of  which  terrain  features  are  incorporated  into  the  OPM. 
Another  important  aspect  of  this  problem  is  the  unifying  perspective  with  regard  to  regions  and  boundaries 
proposed  in  Chapter  V,  Section  C.  Since  there  are  only  three  types  of  non-degenerate  region  roots,  i.e.,  points, 
edges  traversed  length- wise,  and  edges  traversed  cross-wise  (according  to  Snell's  Law),  it  should  be  possible 
at  the  intersection  of  any  two  general  boundaries  to  generate  a  new  boundary  by  considering  the  six  types  of 
boundaries  between  regions  of  three  possible  types  of  roots.  Actually,  as  discussed  in  Chapter  V,  the  Snell's- 
Law  edges  do  not  comprise  a  single  class  of  region  roots,  because  edges  with  different  numbers  of  edge-cross- 
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TABLE  14 
MULTIPLE-FEATURE  OPM  CONSTRUCTION  ALGORITHM 


algoritlim  multiple-featare-opm  (algorithm  VI-9) 

input:  L  a  listing  of  lists  of  vertices  and  types  of  each  terrain  feature,  and 

N,  the  optimal-path  tree  associated  with  Map; 
output:  M,  a  DCEL  describing  the  planar  partition  of  OPM  associated  with  Map,  revised  OPT  N; 
purpose:  to  construct  an  optimal-path  map  for  input  map  consisting  of  any  number  of  terrain  features; 

{ 

if  Map  contains  only  one  terrain  feature  /*  base  case  of  the  recursion.  */ 

OPM  :=  appropriate  single-feature  algorithm; 
else 

I 

(Seti,Set2)  :=  value  returned  by  halve-map;  /*  divide  map  into  two  roughly  equal  sub-maps.  */ 

N|  :=  N  less  region  roots  associated  with  Set2; 

N2  :=  N  less  region  roots  associated  with  Seti; 

OPMi  :=  value  relumed  by  multiple-feature-opm(Seti,  Ni);/*  recursively  solve  each  sub-problem.  */ 

OPM2  :=  value  returned  by  multipIe-feature-opm(Set2,  Ni); 

OPM  :=  result  of  merge-opnis(OPMi,OPM2j^i JN2>        /*  find  OPM  by  merging  two  sub-OPM's.  */ 

} 
)  /*  end  of  muitiple-feature-opm.  */ 


procedure  halve-map 

input:  Map,  tlie  list  of  lists  of  terrain- feature  vertices  and  types; 

output:  a  pair  of  sets  such  that  the  first  is  the  left  half  of  the  map  and  the  secoiKl  is  the  right  half; 

purpose:  divide  Map  into  two  roughly  equal-sized  sub-maps; 

I 

for  each  decomposable  terrain  feature 

find  the  left-most  vertex; 
compute  the  median  x-coordinate; 
for  each  terrain  feature  F 

if  its  left-most  vertex  is  less  than  the  median 

Seti  :=SetiU{F); 
else 

Set2:=Set2U{F); 
I  /*  end  of  halve-map.  */ 
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TABLE  14  (CONTINUED) 
MULTIPLE-FEATURE  OPM  CONSTRUCTION  ALGORITHM 


procedure  merge-opms 

input:  OPM  I  and  OPM2,  DCEL's  of  the  two  input  OEM's; 

output:  OPM,  the  DCEL  containing  the  planar  partition  of  the  merged  map; 

OPT  N,  the  revised  optimal-patli  tree; 
purpose:  merge  two  OPM's  into  one; 
{G  :=  vertical  chain  such  that  all  terrain  features  of  OPMi  are  entirely 

to  its  left  and  all  terrain  features  of  OPM2  are  to  its  right; 
BdrySet  :=  Set  of  all  B  such  that  Be  OPMi  or  Be  OPM2  and  B  intersects  C; 
while  BdrySet  is  changing 
(PairedBdrySet  :=  BdrySet; 
whUe  PairedBdrySet  is  changing 

{ for  all  Bi,je  PairedBdrySet  /*  where  h,  i,  j,  and  k  index  the  regions  of  OPM.  */ 

where  Bij  is  unmarked 
{ discard  Bij  from  PairedBdrySet; 
add  Bi.j  from  BdrySet  to  PairedBdrySet; 
intersect  By  with  Bh,i  and  truncate  both; 
add  Bh/""*^and  Bi.j''""^  to  PairedBdrySet; 
intersect  Bij  with  Bj.k  andtruncate  both; 
add  Bij*™"^  and  Bj.k^"^  :=  to  PairedBdrySet; 

) 
for  all  Bije  PairedBdrySet 

discard  all  but  the  shortest  Bij  from  PairedBdrySet; 
unmaik  all  bdrys  in  PairedBdrySet; 
for  all  Bij  and  Bj,ic€  PairedBdrySet  such  that  Bij  adjoins  Bj.k 

mark  Bij  and  Bj,k; 

} 
for  all  Bi jand  Bj,k€  PairedBdrySet  such  that  Bij  adjoins  Bj,k 

add  Bi,k  to  PairedBdrySet; 
BdrySet  :=  PairedBdrySet; 

) 

for  each  new  B'  €  BdrySet 

{intersect-and-merge(B',  {all  bdrys  from  OPMi  assoc  with  Ri }); 

intersect-and-merge(B',  {all  bdrys  from  OPM2  assoc  with  R2)); 

) 
)  /*  end  of  merge-opms.  */ 

procedure  intersect-and-merge 

input:  B,  a  new  boundary,  and  BdrySet,  a  set  bdrys  potentially  intersecting  B; 
output:  revised  DCEL  M; 

purpose:  propagate  the  effects  of  new  boundary  B  in  one  of  the  subordinate  OPM's; 
{ for  each  bdry  B'  e  BdrySet 
ifB  intersects  B' 

{ truncate  B  aixi  B'at  their  point  of  intersection; 

find  regions  Ri  and  Rj  which  are  adjacent  to  B  and  B 'respectively,  but  not  common  to  both; 
construct  Bncw  by  referring  to  the  roots  of  Ri  and  Rj  respectively; 
for  each  boundary  B"in  BdrySet  which  B'previously  intersected 
intersect-and-merge(B'',  BdrySet  less  B'); 

} 
)  /*  end  of  intersect-and-merge.  */ 
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ing  episodes  enroute  to  the  goal  will  create  boundaries  of  different  analytic  characteristics.  However,  the  con- 
cept is  promising. 

To  divide  decomposable  terrain  features  (see  Section  C  above  for  a  definition  of  decomposability)  of  the 
ii^ut  map  into  two  approximately  equal  sets  whose  resulting  OPM's  can  be  merged  is  not  difficult.  In  fact,  it 
appears  that  any  partition  is  feasible  as  long  as  it  does  not  split  a  terrain  feature,  but  some  will  be  much  more 
efficient  than  others.  Of  course  the  advantage  of  a  divide-and-conquer  algorithm  is  its  logarithmic  performance 
in  the  recursive  stage  if  it  is  guaranteed  that  divisions  are  approximately  equal-sized,  so  any  partitioning  pro- 
cedure should  have  this  property.  Also,  it  should  not  take  an  excessive  amount  of  time  to  accomplish  the  par- 
tition, since  this  step  will  play  an  important  part  in  the  overall  time  complexity.  And  thirdly,  since  the  merging 
step  will  depend  on  checking  for  intersections  between  all  boundaries  of  one  sub-OPM  and  all  boundaries  of 
the  other,  it  would  be  very  useful  if  it  were  not  necessary  actually  to  check  most  of  these  boundaries.  This 
would  be  the  case  if  at  each  step  in  the  recursion,  the  two  OPM's  represented  terrain  which  did  not,  loosely 
speaking,  "interleave".  For  such  OPM's,  boundaries  which  lay  wholly  within  the  interior  of  the  two  planar 
partitions  would  not  have  to  be  checked  for  intersection. 

The  merge  step  depends  on  the  fact  that  any  two  boundaries,  when  they  intersect,  represent  the  meeting 
point  of  three  regions,  one  of  which  is  common  to  both  boundaries.  A  new  boundary  will  emanate  from  the 
point  of  intersection  which  separates  the  two  regions  which  the  original  boundaries  did  not  have  in  common. 
Rather  than  attempt  to  study  all  the  special  cases  of  possible  region  intersections  among  boundaries  present  in 
the  nine  algorithms  thus  far  presented,  it  is  preferable  to  use  the  unifying  s^proach  to  boundary  generation 
which  considers  the  two  types  of  region  roots  involved  and  selects  from  the  limited  number  of  boundary  types 
to  find  the  new  boundary.  However,  since  there  are  infinitely  many  possible  types  of  SneU's-Law  edges  based 
CD  the  number  of  edge-crossings  between  the  edge  and  the  goal,  an  approximate  solution  is  proposed.  Since 
boundaries  between  Snell's-Law  edges  are  similar  to  hyperbolas,  it  is  proposed  that  for  all  except  the  varieties 
already  derived  in  Appendix  A,  hyperbolas  be  used  as  approximations  to  the  exact  curves. 

When  a  new  boundary  has  been  generated  because  of  the  intersection  of  two  boundaries  from  different 
sets,  the  effects  may  propagate  into  both  partial  OPM's.  This  will  be,  in  the  worst  case,  a  very  expensive  opera- 
tioo,  because  unlike  Voronoi  diagram  construction,  the  boundaries  between  regions  are  not  simple  Unes,  and 
the  effects  are  not  guaranteed  to  be  local.  Each  boundary  which  is  truncated  by  the  new  boundary  must  be  fol- 
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lowed  to  its  end  (before  it  was  tnincated),  and  if  it  intersected  other  boundaries,  these  in  turn  must  be  recon- 
sidered with  respect  to  the  new  boundary. 

Algorithm  VI-9  describes  this  method  of  constructing  an  optimal-path  map  for  input  maps  containing 
any  number  of  the  seven  types  of  primitive  tenain  features  and  connected  river  and  road  segments.  At  each 
level  of  recursion,  the  algorithm  divides  the  terrain  into  two  roughly  equal  sets,  based  on  a  calculation  of  the 
median  leftmost  vertex.  At  the  lowest  level,  that  of  a  single  terrain  feature,  the  algorithm  calls  on  Algorithms 
VI-1  through  VI-8  to  construct  an  0PM  for  the  feature.  At  higher  levels,  OPM's  are  merged  by  procedure 
merge-opms. 
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Vn.  ANALYSIS  OF  DIVIDE-AND-CONQUER  EXACT-OPM  ALGORITHM 

A.    SOURCES  OF  ERROR  IN  THE  ALGORITHM 

The  divide-and-conquer  exact-OPM  algorithm  produces  a  more  accurate  optimal-path  map  than  the 
wavefroBrt-prc^agation  OPM  algorithm,  but  it  still  has  error  with  respect  to  the  conceptual  0PM  it  models.  In 
terms  of  the  categories  of  error  discussed  in  Chapter  H,  the  model-cost  versus  real-world-cost  error  occurs  be- 
cause of  approximations  in  the  terrain  database  of  continuously-varying  terrain  with  12.5m  square  cells. 

The  second  category  of  error,  model-computed-cost  versus  model-qptimal-cost,  appears  in  several  forms 
in  the  output  of  this  algorithm.  The  two  most  significant  are  discussed  here.  First,  each  boundary  whose  analyti- 
cal form  does  not  have  a  closed- form  solution  is  represented  by  a  piece  wise-linear  approximation.  These  boun- 
daries are  plotted  parametrically,  iteratively  setting  one  parameter  and  solving  for  the  other.  Fortunately  for 
the  precision  of  the  algorithm,  most  boundaries  have  very  little  curvature  (see  for  example,  Figtues  22, 23,  and 
24).  An  exact  analysis  of  the  impact  of  this  type  of  error  has  not  been  done,  but  the  proof-of-concept  implemen- 
tation for  the  high-cost,  exterior-goal  homogeneous-cost  area  (HCA)  plotted  twenty  or  fewer  points  for  each 
curve,  and  in  all  test  cases,  error  of  this  type  was  too  small  to  be  visible  in  the  laser-printer  output. 

What  error  does  occur  will  have  the  effect  of  causing  start  points  which  are  close  to  a  boundary  to  be 
placed  in  an  incorrect  region.  These  start  points  will  then  be  associated  with  paths  which  are  not  quite  optimal. 
Bat  along  a  boundary  there  are  two  equal-cost  paths  to  the  goal  from  each  start  point.  On  an  approximate 
boundary  one  of  these  two  paths  will  be  slightly  more  costly  than  the  other.  This  error  will  be  no  greater  than 
the  cost-rate  in  the  region  times  the  maximum  distance  of  the  piecewise-linear  approximation  from  the  actual 
curve.  Since  the  approximations  seem  to  be  very  close  to  the  actual  curve  in  observed  cases,  it  seems  safe  to 
stale  that  this  error  can  be  ignored  in  most  practical  applications. 

A  second  source  of  error  in  the  category  of  model-computed-cost  versus  model-optimal-cost  is  using  hy- 
perbolas to  approximate  boundaries  between  homogeneous-behavior  regions  having  paths  with  more  than  two 
Sneli's-Law  crossings.  An  exact  analysis  of  the  error  caused  here  has  not  been  done.  But  for  regions  whose 
paths  have  multiple  Snell's-Law  crossings  leading  to  a  region  root  which  is  a  point,  as  the  regions  lie  frirther 
and  further  away  from  the  point,  they  have  cost  functions  (called  "distorted  cones")  which  have  flatter  and 
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flatter  iso-cost  contours,  leading  to  boundaries  with  less  and  less  curvature.  The  approximating  hyperbola 
should  be  closer  and  closer  to  the  actual  boundary  as  the  boundary  becomes  almost  linear.  The  error  in  the 
computed  cost  of  an  optimal  path  caused  by  (his  approximation  can  be  ignored  in  most  applications. 

The  third  category  of  error  discussed  in  Chapter  n,  that  of  model-computed-location  versus  model-op- 
timal-location, occurs  only  in  the  situations  discussed  above  where  a  start  point  is  incorrectly  placed  on  the 
wrong  side  of  a  boundary.  When  this  happens,  the  computed  path  will  have  a  distinctly  different  behavior  than 
the  true  optimal  path. 

B.    TIME  AND  SPACE  COMPLEXITY  OF  THE  ALGORITHM 

We  begin  by  analyzing  the  construction  of  the  optimal-path  tree,  and  then  analyze  the  algorithms  proposed 
for  each  primitive  terrain  feature  type  in  an  isolated  setting,  because  the  final  algorithm  uses  the  previous  ones 
as  base  cases  of  its  recursion. 

1.  Time  and  Space  Complexity  of  Optimal-Path  Tree  Coiistruction 

Prior  to  the  execution  of  the  algorithms  introduced  in  Chapter  VI,  the  optimal-path  tree  (OPT)  must 
be  constructed.  A  brute-force  method  which  finds  optimal  paths  from  each  terrain-feature  vertex  and  then  in- 
serts each  path  into  the  OPT  would  take,  using  the  continuous-Dijkstra  algorithm,  0(n  jL)  time  in  the  worst 
case,  and  using  recursive  wedge  decomposition,  0(n  )  in  the  average  case,  where  n  is  the  number  of  terrain- 
feature  vertices,  and  L  is  a  measure  of  the  precision  of  the  problem  representation.  Insertion  into  the  OPT  as 
described  in  Chapter  VI  would  take,  in  the  worst  case,  no  more  than  0(n  )  time,  because  no  path  list  is  longer 
than  n,  and  there  are  n  path  lists  to  be  inserted.  The  optimal-path  tree  has  no  more  than  one  node  for  each  ter- 
rain-feature vertex  and  edge,  plus  one  for  the  goal  point.  Thus,  its  worst-case  space  complexity  is  0(n),  since 
with  the  assumed  terrain  constraints,  there  are  0(n)  edges.  A  more  efficient  way  to  use  the  continuous-Dijkstra 
algorithm  is  possible  whidi  computes  patfis  to  all  vertices  and  builds  die  OPT  in  one  execution  of  the  algo- 
rithm,  giving  0(n  L)  worst-case  time  complexity.  Recursive  wedge  decomposition  can  also  be  modified  to 
operate  this  way. 

2.  Time  and  Space  Complexity  of  The  Single-Obstacle-OPM  Algorithm 

Algorithm  VI- 1  constructs  an  optimal-path  map  for  a  single  isolated  convex  obstacle  with  respect  to 
a  goal.  For  an  obstacle  with  n  vertices  there  are  at  most  n  shadow  boundaries,  which  can  be  constructed  in 
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0(n)  time  by  a  depth-first  traversal  of  the  the  optimal-path  tree,  generating  a  shadow  boundary  for  each  node 
in  the  tree  except  the  one  representing  the  empty  path  list.  Each  hypeibola  segment  which  is  part  of  the  op- 
posite edge  can  be  constructed  in  constant  time,  and  there  are  at  most  n-2  intersections  of  the  opposite-edge 
boundary  with  shadow  boundaries.  Thus  the  opposite-edge  boundary  can  be  constructed  in  0(n)  time,  so  the 
entire  OPM  can  be  constructed  in  0(n)  time.  Each  shadow  boundary  and  each  hyperbola  segment  of  the  op- 
posite-edge boundary  can  be  represented  in  O(constant)  space.  Since  the  optimal-path  tree  can  be  stored  in 
0(n)  space,  and  assuming  constant  accuracy,  the  representation  of  the  entire  OPM  is  0(n)  space.  (See  Figure 
17.) 

3.  Time  and  Space  Complexity  of  The  Single-River-Segment-OPM  Algorithm 

Algorithm  VI-2  constructs  boundaries  generated  by  a  single  river  segment.  A  river  segment  has  ex- 
actly two  shadow  boundaries,  at  most  two  river-crossing  boundaries,  and  exactly  one  river-obstacle  boundary 
consisting  of  only  one  hyperbola  segment.  Thus  there  at  most  five  boundaries  to  construct,  each  of  which  can 
be  constructed  in  O(constant)  time,  so  the  time  complexity  of  the  algorithm  is  O(constant).  Similarly,  the  space 
complexity  is  O(constant).  (See  Rgure  18.) 

4.  Time  and  Space  Complexity  of  The  Single-Road-Segment-OPM  Algorithm 

Algorithm  VI-3  constructs  boundaries  generated  by  a  single  road  segment.  By  the  analysis  of  Chap- 
ter V,  a  road  segment  may  have  at  most  fourteen  bouixlaries,  each  of  which  can  be  constructed  in  O(constant) 
time,  using  O(constant)  space.  Thus  the  time  and  space  complexity  of  Algorithm  VI-3  are  both  O(constant). 
(See  Rgure  20  and  21.) 

5.  Time  and  Space  Complexity  of  The  Higli-Cost-Exterior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-4  constructs  the  planar  partition  for  a  region  with  higher  cost  than  the  surrounding  ter- 
rain with  a  goal  point  outside  the  region.  It  has  exterior  boundaries  which  are  similar  in  number  to  those 
generated  by  an  obstacle,  except  that  there  may  be  as  many  as  three  opposite-edge  boundaries.  Thus,  by  the 
same  reasoning  as  for  obstacles,  the  construction  of  exterior  boundaries  has  worst-case  time  and  space  com- 
plexity of  0(n). 

However,  the  interior  boundaries  are  more  time-consuming  in  the  worst  case,  because  of  the  way 
boundaries  may  intersect  (See  Figures  22, 23, 24,  30,  31,  and  32.)  Each  of  the  n  HCA  vertices  is  associated 
with  an  interior  boundary.  In  the  worst  case,  each  pair  of  these  boundaries  intersects  and  a  third  boundary 
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begins  al  the  intersection  point,  giving  n/2  new  boundaries,  and  each  pair  of  new  boundaries  intersects  and 
another  begins,  for  n/4  new  boundaries  at  the  third  level,  and  so  on  until  a  final  boundary  occurs  which  con- 
nects all  the  others.  In  diis  case,  there  are  n+n/2+n/4+n/8+...+l  boundaries.  There  are  in  the  limit  n/(l-l/2)  = 
2n  boundaries. 

There  does  not  appear  to  be  a  simple  way  to  determine  for  a  boundary  which  of  the  two  adjacent 
boundaries  will  be  paired  with  it.  An  iterative  check  which  accomplishes  this  is  outlined  in  procedure  pair- 
and-merge-bdrys  under  Algorithm  Vl-4,  (see  Section  A4  of  Chapter  VI  and  Figure  30).  This  procedure  takes 
at  worst  (in  a  very  pathological  case),  n-2  passes  through  the  inner  ("while  PairedBdrySet  is  changing")  loop, 
which  itself  processes  n  bouiKlaries  ("for  all  Bi,j...").  The  outer  ("while  BdrySet  is  changing")  loop,  which 

checks  for  intersections  by  newly  propagated  boundaries  with  already-paired  boundaries,  could  also  take  0(n) 

•J 
passes  in  the  worst  case.  Thus  procedure  pair-and-merge-bdrys  has  worst-case  time  complexity  of  0(n  ). 

This  measure  dominates  the  0(n)  complexity  of  the  exterior  boundaries,  and  so  the  worst-case  time  complexity 

of  Algorithm  VI-4  is  0(n  ).  The  space  complexity  is  0(n)  because  at  most  2n  interior  boundaries,  n-2  shadow 

boundaries,  and  n-2  portions  of  opposite-edge  boundaries  exist. 

6.  Time  and  Space  Complexity  of  The  High-Cost-Interior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-5  constructs  the  OPM  for  a  high-cost  HCA  with  an  interior  goal  point.  It  has  much 

lower  time  complexity  than  the  high-cost,  exterior-goal  case,  because  the  interior  does  not  have  a  number  of 
intersecting  boundaries  from  which  more  boundaries  may  emanate.  In  fact,  for  each  vertex,  at  most  one  ex- 
terior and  four  interior  boundaries  are  generated,  as  well  as  additional  boundaries  for  each  pair  of  visible  edges 
and  each  interior  opposite-edge  boundary.  Both  the  exterior  visible-edge  boundaries  and  the  exterior  opposite- 
edge  boundaries  display  the  same  behavior  as  obstacle  opposite-edge  boundaries,  so  that  all  of  them  together 
have  no  more  than  0(n)  segments.  The  only  iterative  loq)  in  the  algorithm  is  the  outer  one  which  processes 
each  of  the  n  vertices,  so  the  overall  worst-case  time  complexity  is  0(n),  as  is  the  space  complexity.  (See  Rguie 
25.) 

7.  Time  and  Space  Complexity  of  The  Low-Cost-Exterior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-6  constiucts  the  OPM  for  a  HCA  of  lower  cost  than  the  surrounding  terrain  and  an  ex- 
terior goal.  This  algorithm  generates  at  most  four  boundaries  per  HCA  vertex.  Although  there  are  interior  boun- 
daries similar  to  the  high-cost,  exterior-goal  case  where  much  computing  effort  was  required  to  construct  them. 
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in  this  case  they  are  never  mutually  intersecting.  Thus  the  entire  algorithm  has  time  complexity  0(n).  The 
space  complexity  is  also  0(n).  (See  Figure  27.) 

8.  Time  and  Space  Complexity  of  The  Low-Cost-Interior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-7  constructs  the  0PM  for  a  HCA  with  lower  cost  than  the  surrouixling  terrain,  and  a 

goal  inside  the  HCA.  This  is  the  simplest  of  the  four  HCA  cases,  because  there  are  exactly  two  Unear  boun- 
daries emanating  from  each  HCA  vertex.  Thus  the  time  and  space  complexity  is  0(n).  (See  Figure  26.) 

9.  Time  and  Space  Complexity  of  The  Multiple-Connected-River-Segment-OFM  Algorithm 
Algorithm  VI-8  constructs  an  0PM  for  multiple  connected  river  segments.  The  time  complexity  of 

this  algorithm  depends  on  how  many  "event  points"  and  new  boundaries  occur  at  each  segment.  An  event  point 
occurs  on  a  river  segment  at  each  place  that  a  boundary  intersects  it  and  denotes  a  point  at  which  the  algorithm 
must  check  for  a  continuation  of  the  boundary  on  the  other  side  of  the  segment.  Since  a  river  segment's  boun- 
daries will  only  intersect  river  segments  in  its  shadow,  the  worst-case  time  complexity  happens  when  the  river 
"doubles  back"  on  itself.  Consider  a  sequence  of  connected  river  segments  as  in  Figure  34.  In  this  example, 
the  closest  two  river  segments  to  the  goal,  and  each  subsequent  pair  of  segments,  are  positioned  so  as  to  cast 
two  shadow  boundaries  which  create  event  points  on  the  next  segment.  Since  in  this  example,  the  cost  of  the 
river  is  so  small  that  each  river-crossing  boundary  begins  "outside"  any  event  points  on  the  segment  and  does 
not  intersect  any  shadow  boundaries,  the  shadow  boundaries  all  continue  to  the  next  level  of  river  segments. 
At  the  first  level,  four  boundaries  begin,  and  at  each  subsequent  level,  there  are  three  new  boundaries  plus  the 
continuation  of  boundaries  from  previous  levels  associated  with  event  points.  The  result  is  that  on  each  river 
segment,  say  at  level  i,  there  are  3i+l  possible  boundaries  generated.  So  for  a  sequence  of  river  segments  with 
n  vertices,  it  is  possible  to  have  Zi-=i  ton/2  (3i  +  1)  =  3n  /8  -  7n/4  total  boundaries  over  the  entire  set.  Thus  the 

2  2 

woist-case  time  complexity  of  Algorithm  Vl-8  is  0(n  ).  Since  there  are  0(n  )  boundary  segments,  the  worst- 
case  space  complexity  is  also  0(n  ). 

10.  Time  and  Space  Complexity  of  The  Muitiple-Feature-Divide-and-Conquer-OPM  Algorithm 
Algorithm  VI-9  is  the  algorithm  which  takes  0PM 's  for  individual  decomposable  terrain  features  and 

merges  them  into  one  OPM.  It  uses  the  divide-and-conquer  paradigm,  and  spends  0(n)  time  dividing  the  map 
at  each  stage  of  size  n,  by  standard  median-finding  algorithms  fi^om  computational  geometry.  Let  the  time 
complexity  of  the  algorithm  itself  be  expressed  as  T(n).  Then  the  recursive  application  of  the  algorithm  to  both 
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halves  of  the  map  will  take  2T(ni/2)  time.  Thus  the  dividing,  recursion,  and  merging  will  take  T(n)  =  0(n)  + 
2T(n/2)  +  0(f(n)),  where  f(n)  is  the  lime  complexity  of  the  merge  step. 

The  procedure  merge-opms  is  very  similar  to  procedure  pair-and-merge-bdrys  associated  with  Al- 
gorithm V-4  for  high-cost,  exterior-goal  HCA  OPM's,  which  joined  the  interior  boundaries  and  propagated 
new  ones  as  needed.  It  is  subject  to  the  same  possibility  that  multiple  levels  of  newly-propagated  boundaries 
may  occur,  and  has  the  added  complexity  that  for  each  boundary  truncated  in  one  of  the  subordinate  OPM's, 
the  procedure  intersect-and-merge  must  be  performed  to  reconstruct  any  other  boundaries  which  previously 
intersected  the  truncated  boundary  but  no  longer  do  so.  By  the  same  reasoning  as  paragraph  4  above,  even  as- 
suming that  procedure  intersect-and-merge  has  O(constant)  worst-case  time  complexity,  procedure  merge- 
opms  operates  in  0(n  )  time.  In  fact,  procedure  intersect-and-merge  operates  in  0(n)  lime  in  the  worst  case, 
because  there  are  at  most  0(n)  boundaries  which  a  boundary  can  possibly  intersect.  Thus,  procedure  merge- 
opms  has  worst-case  time  complexity  0(n  ).  We  note  also  that  the  base  case  of  the  recursion  requires  the  solu- 
tion of  a  single-terrain-feature  algorithm,  which  may  have  as  much  as  0(n  )  time  complexity.  Thus  the 
worst-case  time  complexity  of  the  entire  algorithm  may  be  stated  as  T(n)  <i  0(u)  +  2T(n/2)  +  0(n  ),  or 

T(n)  <,  2T(n/2)  +  ©(n'') 

forT(l)  <,  0(m' ),  where  m  is  the  largest  number  of  terrain-feature  vertices  which  occur  in  a  high-cost,  ex- 
terior-goal HCA.  Expanding  this  recurrence  relation,  gives,  by  induction  on  the  depth  i  of  the  recursion,  that 
for  some  constant  ci, 

T(n)  <,  2'  T(n/2')  +  cin^l  - 1/2^^'"'>). 

I, 
Let  n  =  2  ,  assuming  that  k  is  an  integer.  Then  at  the  last  splitting  step,  i^,  and  we  have  that 

T(n)  <,  24'(1)  +  cin\l  -  m^^^'\ 
But  for  the  base  case,  we  have  that  T(l)  ^  C2m  for  some  constant  C2,  so 


T(n)  <,  2''c2m^  +  cin\l  -  ip?^^'^h 


T(n)  <>  C2nm  +  cm  -  8  cm. 


Since  m  ^  n.  Algorithm  VI-9  has  worst-case  time  complexity  T(n)  =  0(n  ). 
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C.    EMPIRICAL  PERFORMANCE  OF  THE  ALGORITHM  IMPLEMENTATION 

The  high-cost,  exterior-goal  case,  was  implemeoted  as  a  proof-of-concept  program.  The  high-cost,  ex- 
terior-goal HCA  was  chosen  because  it  was  the  most  complex  of  the  seven  cases  and  incorporated  most  of  the 
types  of  boundaries.  The  implementation  was  not  intended  to  be  particularly  efficient,  but  was  primarily 
designed  to  corroborate  the  shapes  of  various  boundaries  when  compared  with  multiple  runs  of  a  point-to- 
point  weighted-region  path-planning  implementation  by  Richbourg  [Ref.  21].  Figures  22,  23,  and  24  repre- 
sent results  of  the  0PM  implementation  overlaid  on  vectors  representing  the  initial  directions  of  a  dense 
sampling  of  optimal  paths  from  Richbourg 's  "Snell's  Law"  program.  OPMs  of  fairly  simple  complexity  such 
as  the  above  three  figures  took  four  to  six  minutes  apiece  to  construct,  not  counting  the  time  necessary  to  find 
optimal  paths  from  each  terrain- feature  vertex  using  Richbourg 's  point-to-point  path-planner  [Ref.  21  J.  This 
implementation  was  done  in  C-Prolog  on  a  VAX  1 1/785  ninning  under  BSD  4.3  Unix. 
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Vm.  CONCLUSIONS 

A.  GENERAL 

In  this  research  we  developed  two  approaches  to  the  constiuctioo  of  a  planar  partition  for  optimal-path 
maps  (0PM).  The  flrst  is  an  extension  of  the  grid-based  wavefront  propagation  algorithm  for  point-to-point 
path  planning,  for  which  we  implemented  and  analyzed  three  versions.  The  second  is  based  on  spatial  reason- 
ing about  how  optimal  paths  behave  in  the  presence  of  terrain  features,  leading  to  a  divide-and-conquer  algo- 
rithm. We  assume  that  paths  lie  in  free  terrain  consisting  of  five  types  of  regions:  homogeneous-cost 
background,  convex  polygonal  obstacles,  piecewise-linear  rivers  with  a  fixed  crossing  cost,  piecewise-linear 
roads  with  a  constant  cost-rate,  and  convex  homogeneous-cost  areas.  Additionally,  we  assume  that  no  two  fea- 
tures share  a  vertex.  We  assume  that  the  mobile  agent  is  of  negUgible  size  with  respect  to  the  surrounding  ter- 
rain, and  that  the  terrain  is  fixed  and  known.         - 

Point-to-point  path-planning  algorithms  require  anywhere  from  0(n  log  n)  time  for  binary  terrain 
(visibility- graph  methods  [Ref .  1  ])  to  0(n  L)  time  for  homogeneous-cost  areas  (continuous-Dijkstra  algorithm 
[Ref.  15]),  where  n  is  the  number  of  terrain-feature  vertices  and  L  is  a  measure  of  the  precision  of  the  problem 
representation.  One  way  to  decrease  the  amount  of  run-time  complexity  of  path-planning  at  the  expense  of  in- 
creased preprocessing  time  and  increased  storage  requirements  is  to  construct  optimal-path  maps  (0PM)  which 
group  optimal  paths  from  all  start  points  on  a  map  with  respect  to  a  goal  point  by  partitioning  the  plane  into 
regions  whose  paths  behave  similariy.  At  run-time  standard  point-location  techniques  from  computational 
geometry  can  be  used  to  locate  a  start  point  in  a  region  of  the  0PM  in  0(log  n)  time,  and  the  optimal  path  can 
be  reconstructed  based  on  the  known  behavior  of  paths  in  the  region. 

B.  COMPARISON  OF  WAVEFRONT-PROPAGATION  TO  SPATIAL-  REASONING 
APPROACHES  TO  OPM  CONSTRUCTION 

The  spatial  reasoning  approach  to  optimal-path-map  construction  is  clearly  preferable  to  wavefront 
propagation  for  applications  requiring  low  error  in  the  cost  of  the  solution  path  compared  with  the  cost  of  the 
actual  optimal  path.  Otherwise,  the  wavefront-propagation  approach  using  the  diverging-path  version  seems 


150 


preferable  because  it  does  not  depend  on  the  labeling  of  vertex  or  edge  cells,  and  is  simpler  than  the  exact  al- 
gorithm, when  the  cost  of  constructing  the  optimal-path  tree  is  included.  The  most  accurate  wavefront-propaga- 
tion  0PM  algorithm,  the  vertex-edge  version,  requires  an  additional  preprocessing  phase  which  flts  polygons 
to  grid-based  terrain  features  and  assigns  vertex  and  edge  labels  to  cells.  This  terrain  preprocessing  is  also 
necessary  in  the  spatial-reasoning  approach  used  on  large-scale  cross-country  terrain  data,  because  Defense 
Mapping  Agency  provides  data  in  the  form  of  25  meter  or  1 2.5  meter  square  grid  cells  from  which  the  polygonal 
terrain  features  of  the  spatial-reasoning  approach  must  be  derived.  Since  implementation  of  wavefront  propaga- 
tion is  simpler  than  the  exaa-OPM  divide-and-conquer  algorithm,  it  may  be  preferable  in  applications  which 
can  afford  the  7.6%  inaccuracy  to  use  the  vertex-edge  version  of  wavefront  propagation. 

While  wavefront  propagation  would  seem  to  be  preferable  if  accuracy  is  not  a  factor,  it  should  be  noted 
that  the  complexity  of  wavefront  propagation  is  based  on  the  number  of  cells  in  the  input  map,  not  the  num- 
ber of  terrain-feature  vertices,  so  the  two  time  complexity  measures  are  not  precisely  comparable.  However, 
for  a  grid-based  map  of  0(m)  cells,  with  a  corresponding  polygonal  map  of  v  vertices,  if  it  could  be  said  that 
the  frequency  with  which  a  cell  includes  a  vertex  would  be  constant  as  the  size  of  the  map  increased,  v  would 
increase  linearly  as  a  function  of  m.  By  this  reasoning,  we  could  expect  a  typical  polygonal  map  for  a  grid  with 
m  cells  to  have  0(m)  vertices,  so  the  measures  are  approximately  comparable. 

Actual  average  performance  could  give  different  results  from  worst-case  analysis.  Since  the  spatial- 
reasoning-OPM  divide-and-conquer  algorithm  was  implemented  only  for  one  of  the  seven  cases  as  a  test-of- 
concept  iristiument,  actual  performaiKe  tests  of  the  exact-OPM  algorithm  were  not  possible. 

C.    USEFULNESS  OF  THE  OPM  APPROACH  TO  PATH  PLANNING 

Since  the  OPM  approach  to  path  planning  trades  preprocessing  time  and  increased  storage  for  improved 
speed  at  run-time,  it  will  be  useful  in  jqjplications  which  require  real-time  response  to  a  path-planning  query, 
such  as  autonomous- vehicle  or  missile  path-planning,  or  where  multiple  queries  over  the  same  terrain  are  ex- 
pected, for  example,  in  a  terrain-analysis  decision  aid  for  tactical  military  units. 

Two  major  objections  to  the  OPM  approach  are  its  preprocessing  time  aixl  its  storage  requirements.  Cer- 
tainly preprocessing  will  take  longer  than  current  path-planning  methods.  However,  the  non-automated  ap- 
proach to  terrain  navigation  in  many  domains,  which  has  been  to  prepare  paper  maps  well  ahead  of  time  for 


151 


distribution  to  users,  could  serve  as  a  model  for  0PM  preprocessing,  wherein  an  organization  such  as  Defense 
Maf^ing  Agency  could  devote  centralized  resources  to  the  preprocessing  phase  and  distribute  standard  0PM 
databases  so  that  field  units  or  vehicles  would  have  to  devote  resources  only  to  the  run-time  phase. 

A  second  objection  to  the  0PM  approach  is  the  need  for  increased  storage.  However,  the  cost  and  com- 
pactness of  storage  media  is  constantly  being  reduced  by  research  and  development  efforts.  OPM  databases 
could  be  recorded  on  optical  disks  or  "digital  paper",  allowing  space  for  a  whole  array  of  OPMs  covering  an 
approximation  of  the  four-dimensional  solution  for  a  given  geographical  area.  A  typical  OPM  for  an  area  of 
20  by  20  kilometers  might  include  on  the  order  of  800,000  boundary  segments  (100  vertices  per  square 
kilometer  times  400  square  kilometers  giving  on  the  order  of  40,000  boundaries,  times  20  segments  per  bound- 
aiy),  each  requiring  two  points  of  two  coordinates  each,  or  3.2  megabytes  of  storage.  For  a  four-dimensional 
array  of  OPM's  representing  ail  optimal  paths  from  any  start  point  to  a  sampling  of  perhaps  10  goal  points  per 
square  kilometer,  or  4,000  OPMs,  12.8  gigabytes  would  be  required.  As  of  1989,  5-1/4-inch  disks  using  digi- 
tal-paper technology  are  conrmiercially  available  which  store  1  gigabyte  each  [Ref.  45].  The  approximately 
thirteen  such  disks  needed  to  store  a  full  set  of  OPMs  would  be  easily  transportable.  A  library  of  OPMs  for 
various  potential  areas  of  operation  could  be  maintained,  for  example,  much  as  libraries  of  paper  maps  aie 
maintained. 

D.    AREAS  FOR  ADDITIONAL  RESEARCH 

The  terrain  types  assimied  herein  do  not  include  non-convex  polygons,  even  though  much  real-world  ter- 
rain would  be  difficult  to  model  accurately  without  tl»m.  Thus,  it  is  important  to  determine  how  to  incorporate 
non-convex  polygons  into  the  optimal-path  map  algorithms  presented.  With  the  unifying  view  of  regions  and 
bouDdaries  based  on  region  cost  functions,  this  task  seems  attainable  with  additional  research. 

The  boundary  between  regions  where  one  or  both  regions  have  paths  which  cross  multiple  Snell's-Law 
edges  en  route  to  a  region  root  which  is  a  point  has  not  been  characterized  analytically.  In  the  current  algo- 
rithm, it  is  proposed  that  such  boundaries  be  approximated  by  hyperbolas,  and  it  is  thought  (without  proof) 
that  such  an  approximation  introduces  very  little  error.  However,  a  better  approximation  could  be  used  to  in- 
tersect with  other  cost  functions  to  determine  boundaries  on  a  much  less  ad  hoc  basis  than  is  done  in  this  dis- 
sertation. 
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One  specific  place  in  which  improvement  in  efficiency  could  have  great  effect  on  the  overall  exact-OPM 
algorithm  is  in  constructing  the  interior  boundaries  of  an  exterior- goal,  high-cost  HCA  in  less  than  0(n  )  time. 
OPM's  for  all  six  other  primitive  terrain-features  can  be  coastructed  in  0(n)  or  less  time,  and  for  multiple  con- 
nected  river  segments  in  0(n  )  time,  and  it  is  tliis  single  case  which  drives  the  divide-and-conquer  algorithm 's 
worst-case  time  complexity  to  0(n  ).  In  addition,  a  merge  procedure  for  the  exact-OPM  divide-and-conquer 
algorithm  which  had  efficiency  more  in  line  with  that  of  Voronoi  diagram  construction  would  improve  over- 
all performance. 

A  four-dimensional  solution  is  needed  in  order  to  make  the  OPM  approach  usefiil  in  most  domains.  The 
solution  consistent  with  the  approach  herein  is  to  create  multiple  OPM's  for  a  sampling  of  goal  points  in  the 
plane,  and  then  choose  the  OPM  to  use  at  run-time  based  on  the  proximity  of  the  query  goal  point  to  the  goal 
point  of  one  of  the  OPM's.  Perhaps  more  efficient  methods  exist  which  would  characterize  boundaries  be- 
tween four-dimensional  regions  in  a  space  of  all  start  and  goal  points,  a  conceptual  generalization  of  the  two- 
dimensional  solutions  reported  here  for  start  points  and  a  fixed  goal.  In  other  words,  the  four-dimensional 
hyperplane  would  be  partitioned  into  regions  whose  paths  were  similar. 

It  would  be  very  instructive,  as  well  as  practical,  to  implement  a  complete  two-dimensional  path-plan- 
ning system,  from  construction  of  an  optimal-path  tree  for  the  four  types  of  terrain  used  herein  through  OPM 
construction,  and  including  a  run-time  system  to  accomplish  point  location  and  path  reconstruction. 
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APPENDIX  A  -  THEOREMS 

A.  OVERVIEW 

In  this  appendix  the  theorems  which  form  the  basis  of  the  research  reported  herein  are  presented,  along 
with  associated  lemmas,  corollaries,  and  fundamental  assumptions.  The  theorems  follow  in  the  same  order  in 
which  they  are  discussed  in  the  body  of  this  report,  and  are  numbered  by  chapter  and  theorem.  Lemmas  and 
corollaries  are  numbered  as  extensions  of  the  theorem  to  which  they  apply.  First,  some  notation  used  in  this 
appendix  and  throughout  the  report  is  presented.  Then  three  theorems  and  a  fundamental  assumption  with  three 
associated  corollaries  are  presented  which  provide  a  theoretical  foundation  for  the  discussions  of  Chapter  I. 
Next  six  theorems  are  presented  which  state  the  basic  boundary  equations  as  developed  by  the  unifying  view 
of  region  cost  functions.  Seven  theorems  from  Chapter  V,  one  for  each  of  the  three  terrain-feature  types 
obstacle,  road  segment,  and  river  segment,  and  four  for  the  four  cases  of  the  homogeneous-cost  area,  are 
presented.  The  definition  of  homogeneous-behavior  region  used  in  this  appendix  is  the  set  of  all  points  whose 
optimal  paths  have  the  same  path  list. 

B.  NOTATION 

The  following  notation  is  introduced  for  use  with  respect  to  path-planning. 

ELSmdSi  Description 

P  A  point  in  Euclidean  n-space. 

FQ  The  straight-line  segment  from  P  to  Q 

(PQ)  A  feasible  path  from  P  to  Q 

(PQX  The  i*  feasible  path  from  P  to  Q 

(PQ)*  Optimal  padi  from  P  to  Q 

OPL(P)  Optimal-path  list  (sequence  of  edges  and  vertices  encountered)  of  P. 

OPL(P)  =  [P,QIOPL(Q)]  The  path  list  from  P  through  Q  shown  in  Prolog-style  list  notation 

(i.e.,  lists  are  enclosed  in  braces,  commas  separate  elements,  and  the 
entry  following  a  vertical  line  ("I")  is  the  "rest"  of  the  list). 

\(PQ)i\  The  cost  (weighted  distance)  from  P  to  Q  via  path  (PQ)i. 

d(P,Q)  The  Euclidean  distance  between  P  and  Q. 

((PQ)i(QR)j)  A  feasible  path  from  P  through  Q  to  R. 
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(PQ)iC:  ((PQ)i(QR)j)         Set  notation  applies  to  paths  as  if  to  their  path  lists,  treating  them  as 

(QP)i  a  ((PQ)i(QR)j)        ordered  sets,  e.g.,  (PQ)i  is  a  sub-path  of  ((PQ)i(QR)j).  but 

(QP)i  is  not  a  sub-path  of((PQ)i(QR)j). 

P  G  (PQ)i  Points  are  considered  elements  of  paths. 

(PQX  =  (RS)j  iff  (PQ)iS  (RS)j  and  (RS)jC  (PQ)i        Two  paths  are  equal  if  Vk,  the  k*** 

elements  of  the  path  lists  of  the  two  paths  are  the  same. 

Cpq  The  cost  (weighted  distance)  of  a  path  from  point  P  to  point  Q 

n  The  cost  rate  in  region  i. 

9i  Angle  of  incidence  or  refraction  of  a  path  across  a  Snell's-Law  edge. 

y  =  sin'^n/rz)  Critical  angle  with  respect  to  a  Snell's-Law  edge  separating 

regions  of  cost-rates  ri  and  n,  where  ri  <  n. 

VAGB  The  characteristic  wedge  with  vertex  at  G  and  edges  through  A  and  B. 

This  is  defined  with  respect  to  road  segments  such  that  G  is  the  goal 
point,  A  and  B  are  points  on  the  line  of  the  road  segment,  ray  GA  forms 
angle  7C/2  +  \j/  with  the  segment,  and  ray  GB  forms  an  angle  Jt/2  —  \J/ 
with  the  segment,  where  \|/  is  the  critical  angle  as  defined  above. 

C.    BASIC  THEOREMS 


THEOREM  I-l.Given  optimal  path  (AB)*,  VP  e  (AB)*,  (PB)i  =  (PB)*  if  (PB)i  C  (AB)*,  i.e.,  any  sub- 
path  of  an  optimal  path  is  also  an  optimal  path.  (The  generalization  of  this  concept  is  known  in  some  contexts 
as  the  principle  of  optimality,  the  dynamic  programming  principle,  or  the  Markovian  property  [Ref .  46] .) 

PROOF  I.l:(Proof  by  Contradiction)  Given  points  A  and  B  and  path  (AB)i  =  (AB)*  such  that  l(AB)*l  =  c*. 
points  P  and  Q  such  that  P  e  (AB)*andQ£  (AB)*,  where  paths  (AP),(PQ)  and  (QB)  are  such  that 
((AP)(PQ)(QB))  =  (AB)*  widi  l(PQ)(QB)l  =  ci,  and  Q'  £  (AB)*.  (See  Figure  35.) 

Assume  3  (PQ')  and  (Q'B)  such  that  I((PQ')(Q'B))I  =  ci',  and  ci  <  ci.  Then  3  (AB)2  =  ((AP)(PQ')(Q'B 
))  such  that  l(AB)2l  =  c*  -  ci  +  ci'.  But  c*  -  ci  +  ci'  <  c*  ,  so  l(AB)2l  <  l(AB)*l,  which  contradicts  the  op- 
timality of  (AB)*.  ♦ 

THEOREM  1-2.  In  terrain  consisting  of  a  homogeneous-cost  background  on  which  is  placed  homogeneous- 
cost  polygons,  optimal  paths  change  directions  only  at  terrain  feature  vertices  and  edges.  Note  that  the  terrain 
defined  in  Chapter  II,  Section  E,  are  specializations  of  this  type  of  terrain.  (See  Figure  36.) 
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Figure  35 
Principle  of  Optimality  for  Path  Planning 
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Figure  36 
Optimal-Path  Turn  Points 
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PROOF  1-2:  Consider  point  X  on  optimal  path  (AB)* ,  with  Pe  (AB)*  and  Q  G  ( AB)*  arbitrarily  close  to  X 
such  that  ((PX)(XQ))  d  (AB)*,  i.e.,  P  and  Q  are  on  opposite  sides  of  X  on  path  (AB)*.  Assume  P,  X,  and  Q 
are  not  colinear  (i.e.,  X  is  a  turn-point).  Among  terrain  consisting  of  line  segments  and  polygons,  P  and  Q  can 
be  made  close  enough  to  X  so  that  there  are  only  four  possible  placements  of  P,  X,  and  Q: 

(1)  P,  X,  and  Q  are  in  areas  of  equal  cost,  X  is  not  coincident  with  a  terrain  feature  vertex,  and  line 
segment  PQ  does  not  intersect  any  terrain  feature  edge. 

(2)  P,  X,  and  Q  are  in  areas  of  equal  cost,  and  X  is  coincident  with  a  terrain  feature  vertex. 

(3)  X  is  in  an  area  of  equal  cost  with  either  P  or  Q,  but  not  both.  Assume  without  loss  of  generality 
that  P  and  X  are  in  an  area  of  cost  ri  and  Q  is  in  an  adjacent  area  of  cost  n.  Additionally,  X  is  not 
on  a  terrain  feature  edge,  (PX)  does  not  cross  any  edges,  and  (XQ)  crosses  exactly  one  edge,  the 
edge  between  the  two  areas  of  concern. 

(4)  X  is  on  the  terrain  feature  edge  separating  an  area  of  cost  r  i  of  which  P  is  a  member  and  adjacent 
area  of  cost  rz  of  which  Q  is  a  member.  Additionally,  neither  (PX)  nor  (XQ)  cross  any  other  edges. 

Assume  case  1.  ((PX)(XQ))  =  (PQ)*  by  the  principle  of  optimality.  So  l(PX)l  +  l(XQ)l  <  IPQI,  because 
of  the  optimality  of  ((PX)(XQ))  (i.e.,  the  cost  from  P  to  Q  via  X  is  less  than  the  straight-line  cost  from  P  to  Q). 

So  it  is  also  true  that  l(PX)l/r  -t-  !(XQ)l/r  <  IPQI/r.  Now  VR  and  S,  the  Euclidean  distance  between  R  and 
S  is  less  than  or  equal  to  the  distance  along  any  general  path  between  R  and  S.  So  \(PX)\fr  >  IPXI/r  and 
l(XQ)l/r  >  IXQI/r.  (By  the  notational  convention  that  l(RS)l  is  the  weighted  distance,  or  cost,  between  R  and 
S,  l(RS)IA  is  the  Euclidean  distance  of  (RS)  if  (RS)  lies  entirely  in  an  area  of  cost  rate  r.)  Therefore  IPXI/r  + 
IXQIA^  <  IPQI/r.  But  since  P,  X,  and  Q  are  not  collinear,  this  violates  the  triangle  inequality,  so  case  1  is  not 
possible. 

It  is  clear,  by  example,  that  case  2  is  possible.  Consider  X  coincident  with  the  comer  of  a  rectancular 


obstacle  O,  with  P  and  Q  not  intervisible,  but  closer  to  X  than  to  any  other  vertex  of  O.  (PX  XQ)  =  (PQ)*  in 
this  case,  demonstrating  that  case  2  is  possible,  i.e.,  that  optimal  paths  may  turn  at  terrain-feature  vertices. 
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Assume  case  3.  Let  Y  be  the  point  at  which  (XQ)  crosses  the  edge.  Then  by  the  same  reasoning  as  for 
case  1  above,  it  is  contradicted  that  P,  X,  and  Y  are  not  collinear,  i.e.,  X  is  not  a  turn-point,  so  case  3  is  not 
possible. 

Richbourg  [Ref.  20]  proves  the  applicability  of  Snell's  Law  to  describe  the  angles  of  incidence  and  refrac- 
tion of  an  optimal  path  across  an  edge  as  in  case  4,  demonstrating  that  this  case  is  possible,  i.e.,  that  optimal 
paths  may  turn  as  they  cross  terrain-feature  edges. 

Thus  the  only  turn-points  in  optimal  paths  in  terrain  consisting  of  homogeneous-cost  polygons  on  a 
homogeneous-cost  background  are  coincident  with  terrain  feature  vertices  or  edges.  ♦ 

ASSUMPTION  1-3,  General-Position  Assumption:  No  terrain-feature  vertex  or  edge  interior  lies  on  a  non- 
trivial  homogeneous-behavior-region  boundary,  i.e.,  a  homogeneous -behavior  boundary  other  than  those  of 
the  homogeneous-behavior  region  of  which  the  vertex  or  edge  is  the  root,  or  the  terrain-feature  edges  inci- 
dent upon  the  vertex  or  edge. 

COROLLARY  I-3.1:There  is  a  unique  optimal  path  from  each  terrain-feature  vertex  and  edge  interior. 

PROOF  1-3.1:  (Proof  by  Contradiction)  Assume  that  there  were  two  optimal  paths  from  a  terrain-feature  ver- 
tex OT  edge  interior.  Then  the  vertex  ot  edge  would  lie  on  a  non-trivial  boundary,  by  the  definition  of  a  bound- 
ary. But  this  contradicts  Assumption  1-3.  ♦ 

COROLLARY  1-3.2:  There  is  a  unique  homogeneous-behavior  region  root  associated  with  each 
homogeneous-behavior  region,  where  a  region  root  is  the  first  vertex  or  edge  crossed  by  optimal  paths  which 
start  in  the  region. 
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PROOF  1-3.2:  From  the  definition  of  a  homogeneous-behavior  region  as  the  set  of  points  whose  optimal  paths 
to  a  goal  point  have  the  same  path  list,  the  path  lists  from  all  start-points  in  a  region  are  identical,  so  the  first 
elements  of  the  path  lists  are  also  identical.  Thus  there  is  only  one  root  per  homogeneous-behavior  region.  As- 
siune  there  existed  two  homogeneous-behavior  regions  which  shared  the  same  root  Since  a  region  consists  of 
all  points  with  identical  optimal-path  lists,  then  30PLi  =  [EiResti]  and30PL2  =  [EilRestz]  such  that  Resti 
^  Rest2.  By  the  definition  of  a  boundary,  Ei  would  thus  be  on  the  boundary  between  region  1  and  region  2. 
By  Theorem  1-2,  Ei  must  be  a  terrain-feature  vertex  or  edge,  but  this  contradicts  the  general-position  assump- 
tion. Thus  there  is  only  one  homogeneous-behavior  region  per  root.  ♦ 

DEFINITION  1-3  J:  A  region  R  is  star-shaped  if  3P  €  R  such  that  VQ  E  R  and  VX  E  PQ,  X  E  R. 

COROLLARY  I-3.4:Homogeneous-behavior  regions  are  star-shaped  with  respect  to  their  region  roots. 

PROOF  1-3.4:  By  the  definition  of  a  homogeneous-behavior  region,  all  start-points  in  the  region  have  the 
same  optimal-path  list,  with,  by  the  definition  of  a  region  root,  the  same  first  element  By  Theorem  1-2,  the 
optimal  path  from  each  start-point  to  the  root  is  a  straight  line  segment.  By  the  Theorem  I-l,  all  points  along 
the  line  segment  have  optimal  paths  lying  along  the  line  segment,  so  sharing  the  first  element  of  their  optimal- 
path  lists  as  well,  and  so  by  Corollary  1-3. 1  sharing  optimal-path  lists.  Thus  all  points  along  each  such  line  seg- 
ment lie  in  the  same  homogeneous-behavior  region.  4 

THEOREM  1-4:  Given  a  two-dimensional  map  of  a  finite  number  of  linear  and  polygonal  terrain  features 
and  a  goal-point,  it  has  a  unique  optimal-path  tree. 

PROOF  I-4:Given  a  two-dimensional  m^  M  of  linear  and  polygonal  t^rain  features  and  a  goal  G,  each  point 
S  in  M  either  has  an  optimal  path,  i.e.,  the  feasible  path  of  minimum  cost,  or  else  has  no  feasible  path  to  G.  If 
it  has  an  optimal  path,  then  by  the  definition  of  an  optimal-path  list  and  Theorem  1-2,  it  also  has  an  optimal- 
path  list.  If  it  has  no  feasible  path,  it  is  associated  by  convention  with  the  optimal-path  list  [D>G],  where  Q  rep- 
resents the  null  list  Define  the  relation  R  =  {(PiJPi)  I  OPL(Pi)  =  0PL(P2)) ,  i.e.,  two  points  are  related  by  R 
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if  and  only  if  their  optimal-path  lists  are  identical.  Since  identity  is  an  equivalence  relation,  so  is  R,  so  R  com- 
pletely partitions  the  plane  into  sets  of  points  with  identical  optimal-path  lists.  Since  this  is  the  definition  of  a 
homogeneous-behavior  region,  the  plane  is  completely  partitioned  into  homogeneous-behavior  regions.  Since 
there  are  a  finite  number  of  terrain-feature  vertices  and  edges,  there  are  a  finite  number  of  homogeneous-be- 
havior regions. 

A  directed  acyclic  graph  can  be  used  to  represent  a  partial  order  among  its  nodes  [Ref .  36] .  A  partial  order 
of  a  set  S  is  a  binary  relation  U  such  thatV  a  e  S,  aUa  is  false  ,  i.e.,  U  is  irreflexive,  and  Va,  b,  and  c  G  S  , 
if  aUb  and  bUc,  then  aUc ,  i.e.,  U  is  transitive.  [Ref.  36]  The  set  of  all  homogeneous-behavior  regions  in  map 
M  is  partially  ordered  by  their  optimal-path  lists  as  follows.  Let  U  =  {(Pi  J'z)  I  Pi  C3*2},  i.e,  optimal-path  list 
Pi  precedes  optimal-path  list  P2  in  the  partial  order  if  Pi  is  a  proper  subset  of  P2.  Because  the  relation  "proper 
subset"  induces  a  partial  order  on  a  set  whose  elements  are  sets,  the  relation  U  also  induces  a  partial  order  on 
the  set  of  optimal-path  lists,  and  hence  on  the  set  of  homogeneous-behavior  regions,  of  map  M  with  respect 
to  goal  G.  In  fact,  because  of  the  uniqueness  of  optimal-path  lists  from  region  roots,  a  specialization  of  the 
directed  acyclic  graph,  the  tree,  may  be  used  to  represent  the  partial  order  of  homogeneous-behavior  regions. 
We  call  this  tree  an  optimal-path  tree,  because  it  represents  the  optimal  paths  of  map  M. 

Now  considOT  the  homogeneous-behavior  regions  in  M  with  optimal-path  lists  consisting  of  only  one  ele- 
ment Since  all  optimal-path  lists  for  optimal  paths  to  G  have  by  definition  the  point  G  as  their  last  point,  and 
by  the  definition  of  homogeneous-behavior  regions  as  the  set  of  points  with  identical  optimal-path  lists,  there 
is  only  one  region  with  a  single  element  in  its  optimal-path  list,  the  region  with  the  optimal -path  list  [G],  and 
[G]  is  a  subset  of  all  other  optimal-path  lists.  Thus  [G]  precedes  all  other  optimal-path  lists  in  the  partial  order, 
and  so  is  the  root  of  optimal-path  tree  Tm.g,  the  optimal-path  tree  associated  with  map  M  with  respect  to  goal 
point  G.  ♦ 


161 


D.    PROOFS  FOR  BASIC  BOUNDARY  EQUATIONS 

THEOREM  V-0.1:  (Boundary  between  two  regions  with  paths  which  go  initially  to  two  different  points) 
Given  goal  point  G  and  two  adjacent  homogeneous-behavior  regions  of  cost  rate  r  whose  region  roots  are 
points  Vi  and  V2,  costs  ci  =  l(ViG)*l  and  C2  =  l(V2G)*l  (the  costs  of  optimal  paths  from  Vi  and  V2  respec- 
tively) where  without  loss  of  generality  it  is  assumed  that  C2  >  ci,  the  boundary  between  regions  1  and  2  is  a 
portion  of  the  hyperbola  branch  which  is  closer  to  V2  than  to  Vi,  and  is  described  by 

(Equation  1)  ^       y  2 

a      b 

where  a  =  (C2  -  ci)/2,  c  =  r  d(Vi,V2),  and  b^  =  c^  -  a^,  and  where  the  x-axis  is  oriented  along  the  line  segment 
V1V2  with  the  origin  at  a  point  half-way  between  Vi  and  V2 . 

PROOF  V-0.1:  (See  Figure  37.)  By  the  definition  of  a  homogeneous-behavior  region,  points  in  region  1  all 
have  the  same  path  list,  whose  first  element  is  Vi.  Thus  the  first  leg  of  an  optimal  path  from  any  point  P  in 
region  1  is  PVi.  Similarly,  the  first  leg  from  any  point  P  in  region  2  is  PV2.  The  boundary  between  regions  1 
and  2  is  the  set  of  points  P  such  that  ci  +  IPVil  =  C2  +  IPV2I.  Therefore  IPVil  -  IPV2I  =  C2  -  ci.  From  basic 
analytical  geometry,  the  set  of  points  with  constant  absolute  difference  of  distances  from  two  foci  is  a  hyper- 
bola. Since  the  above  equation  describes  the  signed  difference  of  the  two  distances,  it  represents  one  branch 
of  the  hyperbola,  the  branch  such  that  IPVi  I  >  IPV2I.  Thus  the  branch  on  which  P  lies  is  closer  to  V2  (the  ver- 
tex with  the  higher-cost  optimal  path)  than  to  Vi.  ♦ 

THEOREM  V-0.2:  (Boundary  between  a  region  with  paths  which  go  initially  to  a  point,  and  a  region  with 
paths  which  go  to  and  travel  along  a  linearly-traversed-edge,  or  "road")  Given  goal  point  G  and  two  adjacent 
homogeneous-behavior  regions  with  cost-rate  ro,  one  region  having  point  U  as  root  and  the  other  having  linear- 


ly-traversed edge  VW  as  root,  where  VW  is  a  sub-segment  of  some  terrain-feature  edge  such  that  OPL(V)  = 
[W I  OPL(W)]  and  the  cost-rate  along  the  edge  is  rvw,  (for  example,  a  road  segment  where  paths  leave  the  road 
bom  point  W),  the  boundary  between  them  is  a  portion  of  the  curve 
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Figure  37 
Boundary  Between  Homogeneous-Behavior  Regions  with  Point  Roots 
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2 

(Equation  2)  y  =  4  p  x  , 


where  p  is  defined  as  follows.  From  W  extend  a  ray  WWd  away  from  region  2  (i.e.,  no  point  on  WWd  lies  in 
region  2)  such  that  ZVWWd  =  7t/2  +  \\f,  and  the  distance  between  W  and  Wd  is  (Cw  -  Cu)fro.  Let  point  Ud  be 


the  point  such  that  line  UUd  is  parallel  to  WWd,  and  the  line  UdWd  is  perpendicular  to  line  UUd.  Let  point  O 
be  the  point  on  line  UUd  equidistant  between  U  and  Ud.  Then  the  coordinate  axes  are  the  line  UUd  (x-axis  with 
U  in  the  positive  x  direction)  and  the  line  through  O  parallel  to  UdWd  (y-axis  with  Wd  in  negative  y  direction), 
and  p  =  (Cw  -  Cu)/tX) ,  where  \\f  =  sin"  (rvw/ro)  is  the  critical  angle,  Cw  =  l(WG)*l,  and  Cu  =  l(UG)*l  (the  costs 
of  optimal  paths  to  goal  point  G  from  W  and  U  respectively).  Note  that  the  x-axis  is  the  parabola  axis  and  the 
line  UdWd  is  the  directrix. 

PROOF  V-0.2:  (See  Figure  38.)  The  boundary  between  regions  1  and  2  is  the  set  of  points  P  such  that  the 
cost  of  optimal  paths  which  go  through  U  and  through  W  are  the  same.  The  optimal  path  through  U  begins 
with  the  line  segment  PU  and  continues  with  (UG)*  and  has  total  cost  Cu,  while  the  optimal  path  through  W 


starts  with  the  line  segment  PQ  at  cost-rate  ro,  where  Q  is  a  point  on  VW  between  V  and  W  inclusive,  con- 
tinues along  line  segment  QW  at  cost-rate  rvw,  and  ends  with  path  (WG)*  with  total  cost  Cw.  Thus,  the  bound- 
ary is  described  by  the  equation  ro  d(P,U)  +  Cu  =  ro  d(P,Q)  +  rvwd(Q,W)  +  Cw,  or  rearranging  terms,  d(P,U)  = 
d(P,Q)  +  sin\|/  d(Q,W)  +  (cw  -  Cu)/ro .  Now  ZPQW  =  7l/2  +  \|/  for  a  road,  as  shown  by  Rowe  [Ref.  2].  Ex- 
tending the  line  PQ  to  point  Pd,  as  Figure  38  shows,  the  right-hand  side  of  the  above  equation  is  the  straight- 
line  distance  from  P  to  Pd .  Let  line  D  lie  perpendicular  to  PQ,  through  Pd.  By  Figure  38,  line  D  is  a  distance 
(cw  -  Cu)/ro  from  W.  Thus,  the  above  equation  states  that  P  is  equidistant  from  point  U  and  line  D,  the  defini- 
tion of  a  parabola  with  the  form  of  Equation  2,  where  the  coordinate  axes  are  the  lines  UUd  and  D  as  shown, 
and  p  is  half  the  distance  from  U  to  Ud.  ^ 

THEOREM  \-03:(Boundary  between  regions  having  paths  which  go  to  and  travel  along  two  different  linear- 
ly-traversed edges,  or  "roads  ")  Given  goal  point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost- 
rate  10,  one  region  having  linearly-traversed  edge  XY  as  root  and  the  other  having  linearly-traversed  edge  VW 
as  root,  where  XY  and  VW  are  sub-segments  of  terrain-feature  edges  such  that  OPL(X)  =  [Y  I  OPL(Y)], 
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OPL(V)  =  [W  I  OPL(W)]  and  the  cost-rates  along  the  edges  are  rxy  and  rvw  respectively,  (for  example,  two 


road  segments  where  paths  leave  road  XY  from  point  Y  or  leave  road  VW  at  point  W),  the  boundary  between 
them  is  a  segment  of  line  L  defined  as  follows.  Let  Dxy  be  the  line  which  forms  angle  \|/xy  with  line  XY,  is 
distance  Cy  from  point  Y,  and  lies  on  the  side  of  XY  which  does  not  include  the  region  of  which  XY  is  the 
root  Let  Dvw  be  the  line  which  forms  angle  \|/vw  with  line  VW,  is  distance  Cw  from  point  W,  and  lies  on  the 


side  of  VW  which  does  not  include  the  region  of  which  VW  is  the  root.  Let  Po  be  the  point  of  intersection  of 
Dxy  and  Dvw,  and  let  a  be  the  angle  between  line  XY  and  line  VW.  Then  the  boundary  lies  on  line  L,  which 
is  the  line  through  point  Po  which  lies  at  an  angle  (a  +  \j/vw  +  \|/xy)/2  with  both  Dxy  and  Dvw. 

PROOF  V-0  J:(See  Figure  39)  Consider  the  set  of  points  P  with  two  optimal  paths,  OPLi  =  [Qi,  Y I  OPL(Y)], 
and  OPL2  =  [Q2,  W  I  OPL(W)],  where  Qi  and  Q2  are  the  points  at  which  the  paths  first  enter  edges  XY  and 


VW  respectively.  The  cost  of  OPLi  is  ro  d(P,Qi)  +  sin(yxyd(Qi,Y)  +  Cy  and  the  cost  of  OPL2  is  ro  d(P,Q2)  + 
sin\|/vwd(Q2,W)  +  Cw.  By  Figure  39,  these  are  the  perpendicular  distances  of  P  from  two  lines  Dxy  and  Dvw, 
defined  as  follows.  Dxy  is  the  line  which  forms  angle  \j/xy  with  XY,  is  distance  Cy  from  point  Y,  and  lies  on 
the  opposite  side  of  XY  from  the  region  of  which  XY  is  the  root.  Dvw  is  the  line  which  forms  angle  yvw 


with  VW,  is  distance  Cw  from  point  W,  and  lies  on  the  opposite  side  of  VW  from  the  region  of  which  VW  is 
the  root.  From  analytic  geometry,  a  set  of  points  equidistant  from  two  lines  is  a  line.  The  point  Po,  where  Dxy 
and  Dvw  intersect,  is  distance  zero  from  both  lines,  and  so  lies  on  line  L  which  includes  the  boundary.  By  basic 
plane  geometry,  the  line  equidistant  from  two  intersecting  lines  is  the  line  which  bisects  the  angle  between 
them.  The  angle  between  Dxy  and  Dvw  is  (a  +  \|/xy  +  Vvw),  so  that  line  L  forms  angle  (a  +  \|/xy  +  \|/vw)/2 
with  both  Dxy  and  Dvw.  ♦ 

THEOREM  V-0.4:  (Boundary  between  two  regions  having  paths  which  cross  two  different  edges.)  Given 
goal  point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost-rate  ro,  one  region  having  Snell's- 
Law  edge  VW  and  the  other  having  Snell's-Law  edge  XY,  where  paths  which  cross  VW  go  directly  to  point 
U  at  cost-rate  fvw,  paths  which  cross  XY  go  directly  to  point  Z  at  cost-rate  rxy,  and  where  the  total  cost  from 
U  to  the  goal  is  Cu  and  from  Z  to  the  goal  is  Cz,  the  boundary  between  them  consists  of  points  P  such  that  the 
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Figure  39 
Boundary  Between  Homogeneous-Behavior  Regions  with  Two 

Linearly-Traversed    Roots 
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distance  from  P  to  edge  VW  is  X2,  the  distance  from  VW  to  U  is  xi,  the  distance  from  point  P  to  edge  XY  is 
y2,  and  the  distance  from  XY  to  Z  is  yi,  where  the  seven  equations  of  Equation  Set  4  are  satisfied. 

(Equation  Set 4)  di  siny  dosinP 


^1  =  — rrrs —  •  yi  = 


C0s9l  '  COS03 


docos(63  -  P)   dicos(9i  -  Y)cos(94  +  a) 
-     sing ,  dicos(9i  -7)   cos(92  +  CX).    cos92  cos9icosB4       >.. 

^^  ~    sin94       cos9i  cos92  T  cos(92  +  a)cos(94  +6C)^^ 


cos92  cos94 


X2  = 


do  sinacos(93  -  B)  dicos(9i  -  7)  cos  (94  +  tt) 

COS62  cosoB  cos9i  cos94 

~         (cos(92  +  g)  cos(94  +  oTT 
^       "  cos92  cos94 


Boundary  Condition:  rvwxi  +  rox2  =  rxyyi  +  roy2 

Snell's  Law  for  edge  VW:  rvwsin9 1  =  rosin92 

Snell's  Law  for  edge  XY:  rxysin93  =  rosin94 

where  do,  di,  (X,  P,  and  y  are  constants  as  shown  in  Figure  40,  xi,  X2,  yi,  and  y2  are  distances,  and  9i  and  93 
are  the  dependent  and  independent  variables. 

PROOF  V-0.4:  (See  Figure  40.)  Given  two  adjacent  regions  with  point  P  on  their  boundary,  and  given  that 
the  optimal  paths  from  region  1  cross  edge  VW  obeying  Snell's  Law,  and  then  go  through  point  U  en  route  to 
the  goal,  and  that  optimal  paths  from  region  2  cross  edge  XY  obeying  Snell's  Law,  and  then  go  through  point 
Z  en  route  to  the  goal,  with  costs  as  shown,  the  boundary  condition  is 

(4-1)  rvwxi  +  rox2  =  r^yyi  +  roy2. 

The  Snell's-Law  conditions  across  edges  VW  and  XY  are 

(4-2)  rvwsin9i  =  iosin02  and  rxysin93  =  rDsin94 . 
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cost-rate  =  r 


Figure  40 
Boundary  Between  Homogeneous-Behavior  Regions  Each  with  a 

Snell's-Law  Edge  as  Root 
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Applying  trigonometric  identities  to  the  triangles  UQiI  and  ZQ2I  gives  the  following  for  xi  and  yi. 

(4-3)  di  siny  ,^  ^^  dosinP 

^1    =     — Q.       .  (4-4)     yi    = 


COS01       '  cos  63 


The  law  of  sines  applied  to  AUQiI  gives  that 


(4-5)  ,  XI  sin(  Gi  -  7) 

d2  =  - 


siny 
Substituting  the  expression  for  xi  in  equation  4-3  into  4-5  gives 


(4-6)  ^  di  cos(0i  -  Y) 

d2  = 


cosG 
The  law  of  sines  applied  to  AZQ2I  gives 


(4-7)  ^  yi  cos(03  -  P) 

ds    =    ■ 


sinp 
Substituting  for  the  expressicMi  for  yi  in  Equation  4-4  into  4-7  gives 


(4-8)  ,  docos(03-p) 

d3    = 


COS03 

Applying  trigonometric  identities  to  the  right  triangle  whose  hypotenuse  is  the  line  segment  PQi  gives 
(4-9)  X2COS02  =  dssina  -  y2cos(04  +  Ot) . 

Substituting  the  expression  for  d3  in  Equation  4-8  into  Equation  4-9  gives 

(4-10)  docos(03  -  P)sina  cos(04  +  a) 


^2  =  5 5 -  y2 


COS03  cos  02  COS02 
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Applying  trigonometric  identities  to  the  right  triangle  whose  hypotenuse  is  the  line  segment  PQi  gives 


(4-11)  y2cos04  =  dzsina  -  x2cos(62  +  OC) . 


Substituting  the  expression  for  d2  in  Equation  4-6  into  Equation  4-11  gives 


(4-12)  dicos(Oi -y)sina  cos(62  +  a) 


y2  =     .__Q  ___n —  -  ^2 


COS01  cos  04  COS04 


Substituting  the  expression  for  y2  in  Equation  4-12  into  Equation  4-10  and  simplifying  gives 


(4-13)  do  sinOCcos(93  -  B)  dicos(9i  -  "^  cos  (64  +  a) 

cos(:)2  C0SU3  cosBi  C0SB4 


^■^  ~        (cos(02  +  g)  cos(B4  +  g)  V 

COS02  COS04 


Substituting  the  expression  for  X2  in  Equation  4-13  into  Equation  4-12  and  simplifying  gives 


(4-14)  docos(63  -  P)    dicos(9i  -  y)cos(64  +  a) 

sing    dicos(9i  -  y)   cos(92  +  g).    00502  cos9icos94 

^^    ~     Sin04         C0s9l  '         COS02  '  cos(02  +  g)cos(04  +'^ 

COS02  COS04. 


Equatioas  4-1,  4-2,  4-3,  4-4,  4-13,  and  4-14  are  exactly  Equation  Set  4.  0i  and  03  must  be  iteratively  set  and 
the  results  of  the  first  four  equations  checked  in  the  boundary-condition  equation,  since  there  is  no  known 
closed  form  for  Equation  Set  4.  The  angles  02  :uid  04  are  determined  by  the  Snell's  Law  reiatioas.  ♦ 
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THEOREM  \-O.S:(Boundary  between  a  region  with  paths  which  go  to  and  travel  along  a  linearly-traversed 
edge  ("road")  and  a  region  with  paths  which  cross  an  edge)  Given  goal  point  G  and  two  adjacent  homogeneous- 


behavior  regions  with  cost-rate  ro,  one  region  having  linearly-traversed  edge  VW  as  root,  and  the  other  having 


as  root  Snell's-Law  edge  XY,  where  VW  is  a  sub-segment  of  some  terrain-feature  edge  such  that  OPL(V)  = 
[W I  OPL(W)]  and  the  cost-rate  along  the  edge  is  rvw,  (for  example,  a  road  segment  where  paths  leave  the  road 
from  point  W),  and  where  paths  which  cross  XY  go  directly  to  point  Z  at  cost-rate  rxy,  and  where  the  total  cost 
from  W  to  the  goal  is  Cw,  and  from  Z  to  the  goal  is  Cz.  The  boundary  between  the  regions  consists  of  points  P 
such  that  the  six  equations  of  Equation  Set  5  are  satisfied. 


(Equation  Set  5)   ^^    _     ds  sin (3  ^^  sinOC      ^^    cos(\j/+  a)       ,    sinY 

COS02 


y^  =  "^^i^        y^  =  X, -^^^  -  X2 -3^^ 


d2(cos(62  +  Y)(rosina  -  rvwCosGz)  -h  rpsiny  cos(62  -  a))         

^■^   ~     sin(B2-a-\j/)rvwCos62+rocos(y2  -  a)(sin(92-a-\|/)+ro(cosy2+cos(U2  -  a))) 


+ 


d3cos62(rosinacos[3-i-  rxysin(3cos(92  -CX))  +  (Cz  -  Cw)cos92Cos(\|/-  a) 
sin(62-a-\[/)rvwCOs02+rocos(92  -  a)(sin(62-a-\i/)-i-ro(cosB2+cos(62  -  CX))) 


XI    = 


r..cosfe.r.os(ea.a)(^~M-.) 

.       •  ,,     J  /      rvwCOsBcos  G2  •   n      a  \     /  \      c\ 

d2rosmy-(-  d3( (^-y.n) "*"  rxysmpcosy2)  +  (Cz  -  Cw)cosU2 

rvwCose2  +  rocos(e2  -a)(-^^i_|^2ffital. .  j) 


Snell's  Law  condition  for  edge  XY:  rxy  sinOi  =  ro  sin62 


Snell's  Law  condition  for  edge  VW:  sin\|/=  rvw  /  ro 
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PROOF  V-0.5:(See  Figure  41.)  Given  two  adjacent  regions  with  point  P  on  their  boundary,  and  given  that 


the  optimal  paths  from  region  1  go  directly  to  edge  VW  and  travel  along  it  to  point  W,  and  that  optimal  paths 
from  region  2  cross  edge  XY  obeying  Snell's  Law,  and  then  go  through  point  Z  en  route  to  the  goal,  with  costs 
as  shown  in  Figure  41,  the  boundary  condition  is 

Cry2  +  rxyyi  +  Cz   =   CrX2  +  rvwXl  +  Cw  . 

At  the  two  edges,  the  Snell's-Law  conditions  are 

Cvsin02  =  rxySinGi 
and   sinY=  fvw  /  Cr  . 

The  same  type  of  trigonometric  and  algebraic  reasoning  used  in  Proof  V-0.4  leads  to  the  equations  hsted  in 
Equation  Set  5.  Since  there  is  no  closed-form  expression  for  the  boundary,  an  approximation  is  computed  using 
a  finite  number  of  points.  The  procedure  for  plotting  a  point  on  the  boundary  is  to  set  0i,  use  the  first  Snell's- 
Law  condition  to  solve  for  62,  and  then  solve  for  xi  and  X2.  ♦ 

THEOREM  V-0.6:  {Boundary  between  two  regions  each  having  paths  which  cross  two  edges)  Given  goal 
point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost-rate  ro,  one  region  having  Snell's-Law 


edge  VW  and  the  other  having  Snell's-Law  edge  RS,  where  paths  which  cross  VW  go  from  there  at  cost-rate 
rvw  directly  to  a  Snell's-Law  crossing  at  edge  XY,  and  then  go  at  cost-rate  rxy  directly  to  point  Zi;  paths  which 
cross  RS  go  from  there  at  cost-rate  rrs  directly  to  a  Snell's-Law  crossing  at  edge  TU,  and  then  go  at  cost-rate 
riu  directly  to  point  Z2,  and  where  total  cost  from  Zi  to  the  goal  is  ci  and  from  Z2  to  the  goal  is  C2,  the  bound- 


ary between  them  consists  of  points  P  such  that  the  path  distance  from  P  to  edge  VW  is  y3,  the  path  distance 


from  VW  to  XY  is  y2,  the  path  distance  from  XY  to  point  P  is  yi,  the  path  distance  from  point  P  to  edge  RS 
is  X3,  the  path  distance  from  RS  to  TU  is  X2.  and  the  path  distance  from  TU  to  Z2  is  xi,  where  the  fourteen 
equations  of  Equation  Set  6  are  satisfied. 
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Figure  41 

Boundary  Between  Homogeneous-Behavior  Regions  with  a  Snell's-Law 

Edge  and  a  Linearly-Traversed  Edge  as  Roots 
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(Equation  Set  6)         _     d?  sin(3i 


XI     = 


X2    = 


cosBg 


_    ds  sin  pi 
y^    -    cos6i 


sina3/j.       d7COs(p2 -  Q&\      .._  sintti 


cos 


^6 


(d4 


cosBg 


) .  y2  = 


cos 


B-3 


(di 


d5cos(pi  -  eo 


COSOl 


). 


X3 


Sin(a3  +  Yl)  f  A  d4  COsG?  d7COS(B2  -  68)COS07  . 


COS(65  +  OU  +  Yl) 


sin06~ 


C0SO8 


Wi 


sinYi    ,  ,       dicos02         d5cos(Bi  -  0i)cos92  x 


C0S(B4  -  YO 


cos(64-Yl) 
COS(05  +  OU  +  Yl) 


C0SO3 


m 


COSDl 


Wi 


d3 


d4  COsGt         d5COS((32  -  68)cos64 
sinBe  cosBs 


d3 


d4  COsBv  d7C0S([J2  -  B8)C0SB7 


sinOf 


C0S08 


m 


Boundary  Condition: 


roy3  +  rvwy2  +  rxyyi  =  rox3  +  rrsX2  +  rmxi 


Snell'sLaw: 


rv\«,sin92  =  TxySinOi  rosin94  =  rvwsinGs 


rrssin97  =  TtusinSs 


rosin05  =  rrssin96 


Trigonometric  Identities: 


93  =  ai  -  92 


96  =  a3  -  97 


PROOF  'V-0.6:  (See  Figure  42.)  Given  two  adjacent  regions  with  point  P  on  their  boundar>',  and  given  that 


the  optimal  paths  from  region  1  cross  edge  VW  obeying  Snell's  Law,  then  go  straight  to  edge  XY  and  cross 
it  obeying  Snell's  Law,  and  then  go  through  point  Zi  en  route  to  the  goal,  and  that  optimal  paths  from  region 
2  cross  edge  RS  obeying  Snell's  Law,  then  go  straight  to  edge  TU  and  cross  it  obeying  Snell's  Law,  and  then 
go  through  point  Z2  en  route  to  the  goal,  with  costs  as  shown  in  Figure  42,  the  boundary  condition  is 

roy3  +  rvwy2  +  rxyyi  =  rox3  +  rrsX2  +  rtuxi . 
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Figure  42 
Boundary  Between  Homogeneous-Behavior  Regions  each  with  Two 


Snell's-Law  Edges  as  Roots 
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At  each  edge,  the  Snell's-Law  conditions  are 

rvwsin92  =  rxysin0i 

rosin94  =  rvwSinSs 
TnsinG?  =  FtuSinGg 
rosinGs  =  rrssin06 . 
Trigonometric  identities  applied  to  AV1P1P2  and  AV2P3P4  give  the  relations 

03  =  ai  -  02   and 
06=  as -07  . 


Applying  to  the  diagram  of  Figure  42  the  same  type  of  trigonometric  and  algebraic  reasoning  used  in  Proof 
V-0.4  leads  to  the  equations  listed  in  Equation  Set  6.  By  solving  for  0i  and  08,  a  point  P  on  the  boundary  can 
be  found.  Since  there  is  no  closed-form  expression  for  the  boundary,  an  approximation  is  used  where  a  finite 
number  of  points  are  plotted.  Since  there  is  no  closed-form  expression  for  08  as  a  function  of  0i ,  the  proce- 
dure for  plotting  a  point  on  the  boundary  is  to  set  0i,  iteratively  search  for  a  value  of  08  for  which  the  equa- 
tions of  Equation  Set  6  are  satisfied  (within  some  allowable  error),  and  then  trace  the  Snell's-Law  path  accord- 
ing to  the  heading  for  0i  using  the  values  for  yi,  y2,  and  ys,  or  according  to  the  heading  for  08  using  the 
values  for  xi,  X2,  and  X3.  Note  also  that  the  expression  for  71  is  not  in  closed  form,  and  so  must  be  found  by 
iterative  means.  ♦ 
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E.    PROOFS  FOR  BOUNDARIES  ASSOCIATED  WITH  PRIMITIVE  TERRAIN-FEATURE 
TYPES 

LEMMA  V-1.1 :  If  there  are  feasible  paths  from  a  vertex  of  a  polygonal  obstacle,  then  the  obstacle  edges  con- 
stitute boundaries  between  homogeneous-behavior  regions. 

PROOF  V-1.1:  Trivially  true.  ♦ 

LEMMA  V-1.2:  Each  vertex  V  of  an  obstacle  hidden  edge  generates  a  linear  shadow  boundary  which  is  the 
ray  lying  on  the  line  defined  by  V  and  the  first  point  P  on  OPL(V),  starting  at  V  and  lying  in  the  opposite  direc- 
tion from  P. 

PROOF  V-1.2:  Note  that  if  V  joins  a  hidden  edge  and  a  visible  edge,  point  P  will  not  be  on  the  obstacle 
perimeter  by  the  defmition  of  a  visible  edge;  if  V  joins  two  hidden  edges,  P  will  be  the  other  vertex  of  one  of 
the  hidden  edges.  We  prove  first  that  there  is  a  single  shadow  boundary  associated  with  each  hidden-edge  ver- 
tex, second  that  no  vertices  other  than  hidden-edge  vertices  generate  shadow  boundaries,  and  third,  that  the 
shadow  boundary  is  a  ray  defined  as  stated  in  Lemma  V-1.2. 

First,  consider  point  Q  near  V,  a  hidden-edge  vertex.  Let  P  be  the  first  point  on  OPL(V).  Then  one  of 
three  cases  holds  (see  Figure  43):  either  (a)  Qa  is  in  the  obstacle  interior,  or  (b)  Qb  and  P  are  intervisible,  or 
(c)  Qc  and  P  are  not  intervisible.  Clearly,  if  V  joins  a  hidden  and  a  visible  edge.  Figure  43a  applies,  and  if  V 
joins  two  hidden  edges.  Figure  43b  applies.  Qa  is  separated  from  Qb  and  Qc,  not  by  shadow  boundaries,  but 
by  obstacle-edge  boundaries.  The  optimal  path  from  Qb  is  (QbG)*  =  ((QbP)*  (PG)*),  where  (QbP)*  is  the  line 
segment  PQb.  Thus  the  optimal-path  list  from  Qb  is  OPL(Qb)  =  [P  I  OPL(P)].  The  optimal  path  from  Qc  is 
OPL(QcG)*  =  ((QcV)*(VP)*(PG)*),  where  (QcV)*  and  (VP)*  are  the  line  segments  VQc  and  VP  respective- 
ly. Thus  the  optimal-path  list  from  Qc  is  OPL(Qc)  =  [V,  P  I  OPL(P)].  Thus  OPL(Qb)  ?!=OPL(Qb),  so  Qb  and 
Qc  are  in  different  regions,  so  there  is  a  boundary'  between  them. 

We  show  secondly  that  no  other  vertices  generate  shadow  boundaries.  Assume  vertex  V  does  not  join  a 
hidden  and  a  visible  edge,  or  two  hidden  edges.  Then  it  joins  two  visible  edges.  Thus,  OPL(V)  does  not  in- 
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Figure  43 
Obstacle  Shadow  Boundaries 
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elude  any  vertices  of  the  obstacle,  from  the  definition  of  a  visible  edge.  By  Assumption  1-3,  V  is  not  on  a  non- 
trivial  (i.e.,  non-obstacle-edge)  boundary.  Consider  a  point  Q  arbitrarily  close  to  V.  Clearly,  Q  is  either  in  the 
obstacle  interior  (call  it  Qa)  or  in  its  exterior  (including  its  edges)  (call  it  Qb).  Clearly,  Qa  is  separated  from  Qb 
by  an  obstacle-edge  boundary.  Now  in  the  absence  of  externally-generated  boundaries  in  the  vicinity  of  Vi, 
Qb  can  be  made  close  enough  to  V  that  it  is  in  the  same  region  as  V,  and  so  OPL(V)  =  OPL(Qb).  Thus  in  the 
vicinity  of  V,  there  is  only  one  exterior  region,  and  so  V  does  not  generate  any  shadow  boundaries. 

Thirdly,  we  show  that  each  shadow  boundary  is  a  ray  lying  on  the  line  defined  by  vertex  V  and  P,  the  first 
point  on  OPL(V),  starting  at  V  and  lying  away  from  P.  Consider  a  point  R  on  ray  B  in  Figure  43a  or  43b.  By 


convention,  let  points  on  B  not  be  intervisible  with  P.  Then  (RP)*  =  (RV  VP).  Now  consider  R'  arbitrarily 
close  to  R  but  intervisible  with  P.  By  the  definition  of  intervisibility,  (R'P)*  is  a  straight-line  segment.  Since 
R'  is  arbitrarily  close  to  P,  (R'P)*  must  be  arbitrarily  close  to  (RV  VP) ,  and  so  (RV  VP)  must  be  a  straight- 
line  segment,  collinear  with  P,  V,  and  R.  Since  B  separates  the  region  with  OPL  =  [V,  P  I  OPL(P)]  from  the 
region  with  OPL  =  [P  I  OPL(P)],  B  must  begin  at  V  and  lie  away  from  P.  ♦ 

LEMMA  V-1.3:  A  convex  polygonal  obstacle  has  exactly  one  opposite  edge. 

PROOF  V-U:First,  we  show  that  obstacle  O  with  n  distinct  vertices  has  at  least  one  opposite  edge.  Assume 
O  in  Figure  44a  has  no  opposite  edge.  Then  for  any  hidden  edge  ViVi+i,  either  OPL(Vi)  COPL(Vi+i),  or 
OPL(Vi+i)  c  OPL(Vi),  or  else  ViVi+i  would  be  an  opposite  edge.  Now  consider  vertex  Vi,  a  vertex  joining 
a  hidden  and  a  visible  edge.  By  the  definition  of  visible  edges,  VVk  e  O,  Vk  ^  OPL(Vi).  Therefore,  it 
must  be  that  0PL(V2)  cz:  OPL(Vi).  Since  V1V2  is  not  an  opposite  edge,  OPL(Vi)  C  0PL(V2).  Then  by  in- 
duction on  i,  similar  reasoning  shows  that  Vi,  OPL(Vi)  cOPL(Vi+i).  For  i  =  n,  similar  reasoning  shows  that 
OPL(Vn)  cOPL(Vi).  But  this  statement  contradicts  that  VVk  G  O,  Vk  g  OPL(Vi).  Therefore  by  con- 
tradiction, obstacle  O  has  at  least  one  opposite  edge. 

Now  assume  that  there  are  n  distinct  opposite  edges,  where  n>2.  Choose  any  two  opposite  edges,  say 
ViVi+i  and  VjVj+i,  and  without  loss  of  generality  assume  that  j  >i+l  as  shown  in  Figure  44b.  Since  VjVi+i 
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Figure  44 
Uniqueness  of  Obstacle  Opposite  Edge 
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is  an  opposite  edge,  Vi  g  OPL(V,+  i).  Therefore  OPL(Vi+i)  e  OPL(Vj)  and  OPL(Vi+i)  d  OPL(Vj+i).  By 
similar  reasoning  with  respect  to  edge  VjVj+i,  OPL(Vj+i)  C  OPL(V,)  and  OPL(Vj+i)  COPL(Vi+i).  But 
this  is  a  contradiction,  so  there  must  be  no  more  than  one  opposite  edge. 

Therefore  a  convex  polygonal  obstacle  has  exactly  one  opposite  edge.  ♦ 

LEMMA  V-1.4:  An  opposite-edge  boundary  emanates  from  each  obstacle  opposite  edge  and  consists  of  seg- 
ments of  hyperbolas  such  that  an  initial  hyperbola  segment  starts  at  the  opposite  point  and  is  defined  by  con- 
sidering the  vertices  Vi  and  V2  of  the  opposite  edge  as  its  foci,  with  hyperbolic  constant  being  the  absolute 
value  of  the  difference  of  the  costs  of  (ViG)*  and  (V2G)*,  as  specified  in  Equation  1 .  If  at  any  point  a  shadow 
boundary  intersects  the  opposite-edge  boundarj',  it  will  continue  along  a  new  hyperbola  segment  defined  by 
considering  as  foci,  fu^st,  the  vertex  of  the  edge  which  generated  the  shadow  boundary  and  which  is  closer  to 
the  goal  of  the  two  vertices  of  that  edge,  and  second,  the  focus  of  the  previous  hyperbola  which  is  not  also  a 
vertex  of  the  edge  which  generated  the  shadow. 

PROOF  V-1.4:  Given  a  convex  polygonal  obstacle  O  with  opposite  edge  V1V2,  and  given  point  X  on  V1V2 
such  that  3(XG)i*  and  (XG)2*,  (XG)i*  ^  (XG)2*,  i.e.,  X  is  the  opposite  point.  Since  V1V2  is  a  hidden  edge, 
then  it  must  be  that  OPLi(X)  =  [Vi  I  OPL(Vi)]  and  0PL2(X)  =  [V2  I  0PL(V2)]  (see  Figure  45a).  Consider 
point  P  arbitrarily  close  to  X  in  the  obstacle  exterior.  By  Theorem  1-2,  (PVi)*  =  IPVjl  and  (PV2)*  =  IPV2I,  be- 
cause no  other  terrain  features  intervene,  so  P  is  in  both  the  homogeneous-behavior  region  with  Vi  as  root  and 
the  region  with  V2  as  root.  By  Theorem  V-0.1 ,  the  set  of  points  P  is  described  by  Equation  1 . 

Let  Bi  be  the  set  of  points  over  which  P  obeys  the  Equation  1.  As  P  moves  away  from  X,  it  lies  on  Bi 
only  as  long  as  PVi  CI  (PG)i*  and  PV2  C  (PG)2*,  i.e.,  as  long  as  the  line  segment  from  P  to  both  vertices  are 
part  of  the  respective  optimal  paths  from  P  in  the  two  directions.  If  at  some  point  Z  it  becomes  true  that  PVi 
<Z  (PG)i*,  for  i=l  or  i=2,  then  at  that  point  Bi  must  have  intersected  shadow  boundary  i  (see  Figure  45b). 
Now  the  same  reasoning  as  above  applies  to  the  point  Vk,  where  OPL(V,)  =  [Vk  I  OPL(Vk)],  and  so  another 
hyperbola  branch  B2  becomes  the  adjoining  portion  of  the  opposite-edge  boundary.  Since  point  Z  lay  on  both 
hyperbola  branches  Bi  and  B2  ,  it  must  be  that  Biand  B2  intersect  at  point  Z.  The  same  reasoning  continues 
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Figure  45 
Obstacle   Opposite-Edge   Boundary' 
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to  apply  as  long  as  Bj  intersects  any  shadow  boundary  of  obstacle  O.  Therefore  the  opposiie-edge  boundary 
is  a  connected  sequence  of  hyperbola  segments  starting  at  the  opposite  point,  and  for  each  segment  consisting 
of  a  portion  of  the  hyperbola  branch  with  the  two  visible  obstacle  vertices  as  foci  and  the  hyperbolic  constant 
being  c2-ci,  where  C2>ci.  ♦ 

THEOREM  V-1:  A  convex  polygonal  obstacle  in  homogeneous  background  terrain  with  specified  goal-point 
will  generate  as  boundaries  the  obstacle  edges,  shadow  boundaries  from  each  vertex  of  a  hidden  edge  as 
specified  in  Lemma  V-1. 2,  and  a  single  opposite-edge  boundary  consisting  of  piecewise  hyperbolic  segments 
as  specified  in  Lemma  V-1.4. 

PROOF  V-1:  Theorem  V-1  follows  directly  from  Lemma  V-1.1,  Lemma  V-L2,  and  Lemma  V-1.4. 

LEMMA  V-2.1:  A  river  segment,  or  river-edge,  constitutes  a  boundary  between  regions. 

PROOF  V-2.1:  (See  Figure  46a.)  Given  river  segment  V1V2,  and  point  Xi  arbitrarily  close  to  V1V2  having 
optimal-path  listOPL(Xi)  =  [W  I  OPL(W)]  where  W  g  V1V2, i.e., Xi'soptimal  path  does  not  cross  theriver, 
and  point  X2  arbitrarily  close  to  Vi  V2  on  the  opposite  side  V1V2 .  Now  X2  may  have  one  of  three  possible  op- 
timal-path lists:  OPLa  (X2  )  =  [Vi  I  OPL(Vi)]  i.e.,  it  goes  around  end  1  of  the  river,  or  0PLb(X2)  =  [V2  I 
0PL(V2)],  i.e.,  it  goes  around  end  2  of  the  river,  or  0PLc(X2)  =  [[V1V2]  I  OPL(W)]  where  [V1V2]  specifies 
that  the  path  crosses  the  river  without  changing  direction,  and  W  is  the  next  point  on  the  optimal-path  list. 
Since  in  all  three  cases,  the  optimal-path  list  of  X2  is  different  from  that  of  Xi  ,  therefore  Xi  and  X2  are  in 
different  regions.  Therefore  the  river  edge  constitutes  a  boundary.  ♦ 

LEMMA  V-2.2:  Each  river  vertex  V  with  OPL(V)  =  [W  I  OPL(\V0]  which  is  an  endpoint  of  a  river  segment 
not  joining  any  others  wiU  generate  a  shadow  boundary  which  is  a  ray  lying  on  the  line  VW,  starting  at  V  and 
lying  away  from  W. 
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Figure  46 
River  Sesment  Boundaries 
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PROOF  V-2.2:  Given  the  same  situation  as  in  Proof  V-2.1.  analyze  OPLa  (X2  )  =  [Vi  I  OPL(Vi)]  and 
OPLb(X2)  =  [V2 1 0PL(V2)],  with  respect  to  vertices  Vi  and  V2  in  the  same  manner  as  in  Proof  V- 1.2  to  show 
that  there  are  rays  emanating  from  Vi  and  V2  lying  away  from  the  goal  which  act  as  boundaries  between  op- 
timal paths  which  go  around  the  vertices  and  those  which  bypass  them.  Note  that,  assuming  a  positive  river- 
crossing  cost,  location  c  for  X2  will  never  be  such  that  X2  ,  Vi,  and  the  next  point  in  OPLc(Vi)  are  collinear, 
because  if  so,  it  will  be  less  costly  for  the  optimal  path  to  avoid  crossing  the  river  and  go  around  vertex  Vi  in- 
stead. ♦ 

LEMMA  V-2.3:  A  river  segment  with  vertex  V  with  OPL(V)  =  [W  I  OPL(W)]  not  adjoining  any  other  river 
segment  may  have  a  river-crossing  boundary  which  is  a  segment  of  one  branch  of  a  hyperbola  constructed  by 
considering  as  foci  the  points  V  and  W,  with  hyperboUc  constant  c  =  IVWI  -  Cr,  where  Cr  is  the  fixed  river- 
crossing  cost.  This  boundary  will  exist  if  the  branch  closer  to  V  intersects  the  river  segment.  The  boundary 
consists  of  the  portion  of  the  hyperbola  branch  between  the  intersection  of  the  branch  with  the  river,  and  the 
first  point  of  intersection  of  the  branch  with  another  river  boundary. 

PROOF  V-2.3:  Consider  point  P  which  lies  in  the  shadow  of  river  segment  with  vertex  V  as  in  Figure  46b, 
where  ro  is  the  cost  rate  for  travel  in  the  background  region.  As  in  Figure  46a,  there  are  only  three  possible 
ways  the  optimal  path  from  P  can  go  initially.  If  P  hes  on  a  boundary  between  paths  which  cross  the  river 
paying  the  fixed  crossing  cost,  and  paths  which  go  through  V,  the  first  region  has  V  as  its  root  and  the  second 
region  has  the  river  segment  as  its  root.  Optimal  paths  crossing  river  segments  do  not  change  headings.  There- 
fore, the  path  from  P  to  W  has  cost  Cpw  =  ro  d(P,W)  +  Cr.  The  cost  of  the  path  from  P  to  V  has  cost  Cpv  =  ro 
d(P,V),  as  usual  with  a  point  root,  and  the  cost  Cw  from  W  is  known.  But  this  is  just  as  if  paths  in  region  2  had 
W  as  a  root,  where  the  cost  from  W  to  G  was  Cw  +  Cr.  Thus,  the  boundary  separates  two  regions  whose  roots 
are  points,  so  by  Theorem  V-0. 1 ,  the  boundary  is  a  hyperbola  segment  described  by  Equation  1 .  If  Cr  and  the 


orientation  of  VW  are  such  that  the  boundary  does  not  intersect  the  river  segment  between  V  and  U,  it  must 
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be  that  for  all  points  in  the  shadow  of  the  river  segment,  it  is  more  costly  to  cross  the  river  than  to  go  around 
viaV.  ♦ 

LEMMA  V-2.4:  A  river  segment  with  vertices  Vi  and  V2  has  an  opposite-edge  boundary  which  lies  on  the 
hyperbola  formed  by  considering  each  vertex  as  a  focus  conforming  to  Equation  1 ,  and  lies  on  the  branch  of 
the  hyperbola  which  is  closer  to  the  vertex  with  higher-cost  optimal  path. 

PROOF  V-2.4:  Consider  point  Q  in  Figure  46b.  This  point  is  on  the  boundary  which  separates  region  1  from 
region  3.  Optimal  path  from  Q  through  region  1  goes  through  V,  while  the  optimal  path  through  region  2  goes 
through  U.  Thus,  the  boundary  separates  regions  whose  roots  are  both  points,  so  Theorem  V-0.1  applies.  ♦ 

THEOREM  V-2:  An  isolated  river  segment  has  a  river-edge  boundary,  two  shadow  boundaries  formed  as 
specified  in  Lemma  V-2.2,  an  opposite-edge  boundary  formed  as  specified  in  Lemma  V-2.4,  and  either  two, 
or  no,  river-crossing  boundaries  as  specified  in  Lemma  V-2.3. 

PROOF  V-2:  Consider  points  Xi,  X2,  Vi  and  V2  as  in  Proof  V-2.1  and  Figure  46a,  with  optimal-path  lists 
OPL(Xi),  OPL(Xa),  OPL(Xb),  and  OPL(Xc)  as  described  in  Proof  V-2. 1 .  Clearly,  these  four  optimal-path  Usts 
are  the  only  ones  possible  for  points  arbitrarily  close  to  an  isolated  river  segment,  so  by  the  definition  of  a 
homogeneous-behavior  region,  there  are  no  more  than  four  regions  associated  with  a  river  segment.  Thus  the 
only  boundaries  possible  adjacent  tc  an  isolated  river  segment  are  those  between  pairs  of  these  four  regions, 
plus  a  fifth,  the  region  unaffected  by  the  river.  The  form  of  each  boundary  follows  directly  from  Lemmas  V- 
2.1,  V-2.2,  V-2.3,  and  V-2.4.  ♦ 

LEMMA  V-3.1:A  road-edge  forms  a  boundary  between  homogeneous-  behavior  regions. 

PROOF  V-3.1:  Trivially  true.  ♦ 
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LEMMA  V-3.2:Given  road  segment  with  goal  G,  one  vertex  V,  and  the  other  vertex's  location  unspecified, 
and  cost-rate  rr,  with  cost-rate  in  the  background  ro.  If  the  characteristic  wedge  VaGB  as  defined  in  Chapter 
V  lies  "inside"  road-  vertex  V,  two  road-end/road-travellinghoundaxi&s  will  be  formed  as  rays  with  vertex  at 
V,  each  lying  so  that  its  angle  with  the  road  is  7l/2  +  \\f. 

PROOF  V-3.2:Consider  the  road  segment  of  Figure  47a,  with  goal  G,  one  vertex  V,  and  the  other  vertex's 
location  unspecified,  and  cost-rate  rr,  with  cost-rate  in  the  background  ro.  As  shown  in  [Ref.  2],  paths  will  enter 
leave  a  road  interior  only  at  the  critical  angle  \\f  =  sin"  (rr/ro).  Thus  a  path  leaving  the  road  to  point  G  will  do 
so  at  point  A.  If  GA  does  not  intersect  the  road  at  or  to  the  "left"  (in  the  figure)  of  V,  no  paths  will  travel  along 
the  road  from  the  direction  of  V.  Otherwise,  VaGB  is  said  to  lie  "outside"  V,  and  paths  travel  along  the  road 
from  V.  Consider  points  Pi  and  P2  in  the  vicinity  of  P.  If  P  is  arbitrarily  close  to  V,  the  path  from  Pi  will  enter 
the  road  at  angle  \|/  en  route  to  A,  while  the  path  from  P2  will  enter  the  road  at  V.  Thus,  the  set  of  boundary 
points  P  lies  on  ray  VP  such  that  ZPVA  =  7l/2  +  \\f.  The  same  reasoning  with  respect  to  point  Q  gives  that 
ray  VQ  also  is  a  boundary.  ♦ 

LEMMA  V-3.3:Given  road  segment  with  goal  G,  one  vertex  V,  and  the  other  vertex's  location  unspecified, 
and  cost-rate  rr,  with  cost-rate  in  the  background  ro.  If  the  characteristic  wedge  VaGB  lies  "inside"  road- 
vertex  V,  a  road-end/goal  boundary  will  exist  on  the  V  end  of  the  road  segment,  forming  a  segment  of  a  hy- 
perbola with  V  and  G  as  foci  and  obeying  Equation  1. 

PROOF  V-3.3:Consider  point  P  in  Figure  47b,  with  OPLi(P)  =  [V,  A,  G],  and  OPLiCP)  =  [G].  Since  the  two 
regions  through  which  the  optimal  paths  from  P  lie  have  points  as  roots.  Equation  1  applies,  and  the  bound- 
ary is  a  hyperbola  segment  with  V  and  G  as  foci.  The  boundary  will  begin  at  the  point  at  which  the  hyperbola 
intersects  the  road-  end/road-travelling  boundary  of  Lemma  V-3.2.t 

LEMMA  V-3.4:Given  road  segment  with  goal  G,  vertices  Vi  and  V2,  and  cost-rate  rr,  with  cost-rate  in  the 
background  ro.  If  the  characteristic  wedge  VaGB  lies  "inside"  road-vertex  Vi,  a  near-side-road-travell- 
inglgoal  wil  exist  on  the  near  side  of  the  river  which  forms  a  parabola  with  focus  G  and  directrix  as  specified 
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Figure  47 
Road  Segment  Boundaries 
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in  Equation  2.  The  boundary  will  begin  at  the  point  of  intersection  of  the  parabola  with  the  road  segment, 
which  will  be  at  V2  if  VaGB  hes  "outside"  V2,  and  will  be  at  A  otherwise. 

PROOF  V-3.4:From  Figure  47c,  the  paths  from  P  go  to  the  road  and  travel  along  it,  or  go  to  the  goal.  Thus, 
the  boundary  is  between  regions  with  f>oint  root  and  road  root,  so  Equation  2  applies.  Since  paths  leave  the 
road  at  W  in  Figure  37,  point  V2  will  correspond  to  point  W  if  the  wedge  is  "outside"  V2,  or  point  A  will  cor- 
respond to  point  W  otherwise.  ♦ 

LEMMA  V-3.5:Given  road  segment  and  goal  G.  If  VaGB  is  "inside"  road  vertex  V,  a  road-travelling/road- 
crossing  boundary  will  be  formed  on  the  far  side  of  the  river  which  is  a  ray  with  vertex  at  point  A  and  col- 
linear  with  GA  lying  away  from  G. 

PROOF:  V-3.5:If  VAGB  is  "inside"  V,  Figure  47d  will  apply.  Paths  from  points  Pi  just  to  the  "left"  of  P  in 
the  figure  will  cross  the  road  directly  to  G,  while  the  path  from  P  and  P2  enter  the  road  and  travel  along  it  to 
A,  where  they  exit  to  G.  ♦ 

LEMMA  V-3.6:Given  a  road  segment  with  vertex  V  and  goal  G,  with  road  cost-rate  rr  and  background  cost- 
rate  ro.  Afar-side-road-travelling/goal  boundary  will  exist  if  Vis  outside  V.  The  boundary  will  be  a  parabola 
which  begins  at  V  and  lies  away  from  the  goal. 

PROOF  V-3.6:From  Figure  47f,  the  paths  from  P  go  to  the  road  and  travel  along  it,  or  go  to  the  goal.  Thus, 
the  boundar)'  is  between  regions  with  point  root  and  road  root,  so  Equation  2  applies.  Since  the  point  W  in 
Figure  37  is  the  point  at  which  paths  leave  the  road,  V  will  correspond  to  point  W.  ♦ 

LEMMA  V-3.7:If  VaGB  "su-addles"  V,  a  road  shadow  boundary  will  exist  as  a  ray  from  V,  collinear  with 
GA,  and  lying  away  from  G. 
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PROOF  V-3.7:From  Figure  47g,  a  path  from  Pi  will  cross  the  road,  while  a  path  from  P2  will  bypass  it.  This 
will  occur  only  if  VAGB  "straddles"  V,  because  otherwise  paths  from  P2  will  enter  the  road  and  travel  along 
it  to  A.  ♦ 

THEOREM  V-3:Given  a  road  segment  V1V2  with  cost-rate  rr,  a  goal  G,  and  a  background  cost-rate  ro,  if 
characteristic  wedge  VAGB  is  "inside"  Vi,  one  road-end/road-traveUing,  two  road-end,  one  near-side-road- 
travelUng/goal,  and  one  road-  travelUng/road-crossing  boundaries  exist  on  the  Vi  end  of  the  road  segment; 
when  VaGB  "straddles"  Vi,  a  road  shadow  boundary  exists  on  the  Vi  end;  when  VaGB  is  "outside"  Vi,  one 
near-side-road-traveUing/goal  and  one  far-side-road-travelling/goal  boundaries  exist  on  the  Vi  end;  and  the 
road  segment  is  always  a  boundary.  The  form  of  these  boundaries  is  as  described  in  Lemmas  V-3.1  through 
V-3.7. 

PROOF  V-3:Follows  directly  from  Lemmas  V-3.1  through  V-3.7.  ♦ 

LEMMA  V-4.1  :Given  high-cost,  exterior-goal  HCA  with  two  visible  edges  Vi  V2  and  V3  V4,  if  the  two  regions 
whose  paths  cross  the  two  edges  are  adjacent,  the  visible-edge  boundary  between  them  is  described  by  Equa- 
tion Set  4. 

PROOF  V-4.1:Per  Figure  48a,  the  edges  V1V2  and  V3V4  are  roots  of  region  1  and  region  2  respectively.  Paths 
which  cross  them  go  directly  to  G,  and  so  the  description  of  Theorem  V-0.4  appUes  to  this  situation,  and  Equa- 
tion Set  4  describes  the  boundary.  ♦ 

LEMMA  V-4.2:Given  high-cost,  exterior-goal  HCA  with  a  visible  edge  Vi  V2  and  a  hidden  edge  V3V4,  if  the 
region  whose  paths  cross  edge  V1V2  and  the  region  whose  paths  go  to  and  travel  along  edge  V3V4  are  ad- 
jacent, the  visible-hidden-edge  boundary  between  them  is  described  by  Equation  Set  5. 

PROOF  V-4.2:Per  Figure  48a,  the  edges  ViV2and  V5V6are  roots  of  region  1  and  region  3  respectively.  Paths 
which  cross  edge  Vi  V2  obey  Sncll's  Law,  and  then  go  directly  to  G,  while  those  which  u-avcl  along  edge  V5V6 


Figure  48 
High-Cost  Exterior-Goal  HCA  Boundaries 
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leave  the  edge  at  point  V5  en  route  to  the  goal  and  so  the  description  of  Theorem  V-0.5  applies  to  this  situa- 
tion, and  Equation  Set  5  describes  the  boundary.  ♦ 

LEMMA  V-4.3;Given  high-cost,  exlerior-goal  HCA  with  two  hidden  edges  V4V5  and  V6V7,  such  that 
0PL(P6)  =  [V5,  V4  I  OPL(P4)],  if  the  two  regions  whose  paths  enter  and  travel  along  the  two  edges  are  ad- 
jacent, the  hidden-edge-merging-pathhoundzry  between  them  is  described  by  Equation  Set  3.  ♦ 

PROOF  V-4.3:Per  Figure  48c,  the  edges  V4V5  and  V6V7  are  roots  of  region  4  and  region  5  respectively.  Paths 
which  enter  edge  V4V5  at  the  critical  angle  travel  along  it  and  leave  at  V4  en  route  to  the  goal,  while  those 
which  travel  along  edge  V6V7  leave  the  edge  at  point  V6,  eventually  merging  with  paths  from  region  4.  So  the 
two  edges  are  linearly-  traversed  edges  and  are  the  roots  of  regions  4  and  5,  so  the  description  of  Theorem  V- 
0.3  applies  to  this  situation,  and  the  boundary  is  a  Une  segment  as  described  therein.  ♦ 

LEMMA  V-4.4:Given  high-cost,  exterior-goal  HCA  with  two  hidden  edges  V4V5  and  V6V7,  such  that 
0PL(P6)  =  [V5,  V4  I  0PL(P4)],  if  the  two  regions  whose  paths  enter  and  travel  along  the  two  edges  are  ad- 
jacent, the  hidden-edge-diver ging-path  boundary  between  them  is  a  line  segment  described  by  Theorem  V- 
0.3. 

PROOF  V-4.4:Per  Figure  48e,  the  edges  V4V5  and  V7V8  are  roots  of  region  4  and  region  6  respectively.  Paths 
which  enter  edge  V4V5  at  the  critical  angle  travel  along  it  and  leave  at  V4  en  route  to  the  goal,  while  those 
which  travel  along  edge  V7V8  leave  the  edge  at  point  Vg  (going  in  the  other  direction  around  the  exterior  of 
the  HCA).  So  the  two  edges  are  linearly-  traversed  edges  and  are  the  roots  of  regions  4  and  6,  so  the  bound- 
ary between  them  is  a  line  segment  as  described  in  Theorem  V-0.3.  ♦ 

LEMMA  V-4.5:Given  a  high-cost  HCA  with  exterior  goal  G  and  vertices  Vi.  There  is  a  boundary  associated 
with  each  Vi  such  that  optimal  paths  in  one  region  cross  edge  Vj-iVi  and  optimal  paths  in  the  other  region 
cross  edge  ViVi+i,  except  in  the  case  that  shorcutting  occurs  along  the  entire  edge  VjVi+i  to  edge  Vj-i  Vi,  in 
which  case  no  boundary  occurs  for  vertex  Vi. 
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PROOF  V-4.6:There  are  three  cases:  both  edges  are  visible,  one  edge  is  visible  and  the  other  is  hidden,  or 
both  edges  are  hidden.  When  both  edges  are  visible,  by  definition  optimal  paths  from  neither  vertex  includes 
points  along  an  edge  of  the  HCA.  Consider  Figure  30,  and  points  near  V2  in  the  HCA  interior.  Since  the  inte- 
rior has  higher  cost-rate  than  the  exterior,  there  is  no  incentive  for  paths  from  points  close  to  the  visible  edge 
to  move  further  away  from  it.  Rather,  such  paths  will  cross  the  edge  as  soon  as  possible  to  use  the  lower-rate 
exterior.  Thus  there  are  some  points  in  the  interior  close  to  Vi  whose  paths  cross  edge  Vi-i  Vi  and  some  whose 
paths  cross  edge  ViVi+i.  There  is,  therefore,  a  boundary  between  them  which  begins  at  Vi  and  lies  in  the  HCA 
interior. 

In  the  second  case,  by  the  same  reasoning  as  above,  some  paths  whose  start  points  are  close  to  Vi  will 
cross  visible  edge  Vi-i  Vi.  But  some  points  close  to  Vi  may  be  far  enough  from  edge  Vi-i  V,  that  it  will  be  less 
costly  to  move  initially  away  from  the  goal  to  edge  ViVi+i  in  order  to  travel  at  the  less  expensive  exterior  rate. 
Clearly,  this  will  cause  a  boundary  which  begins  at  Vi.  If,  however,  edge  ViVi+i  forms  an  acute  enough  angle 
with  Vi-iVi  that  there  are  no  points  near  Vi  for  which  it  will  be  less  costly  to  move  away  from  the  goal.  In  this 
situation,  shortcutting  will  occur,  at  least  in  the  vicinity  of  Vi.  If  some  paths  travel  along  edge  ViVi+i,  the  point 
at  which  they  shortcut  into  the  interior  will  be  the  beginning  of  the  boundary  associated  with  Vi,  because  points 
just  inside  ViVi+i  and  toward  Vi+i  from  the  shortcutting  point  will  have  less  costly  paths  by  moving  away 
from  the  goal  to  the  lower-rate  edge,  while  points  just  inside  but  toward  Vi  from  the  shortcutting  point  will  go 
directly  across  the  HCA.  If  shortcutting  occurs  all  along  edge  ViVi+i,  however,  there  will  be  no  boundary  as- 
sociated with  Vi,  because  all  paths  have  the  same  behavior.  In  the  third  case,  by  the  same  reasoning  as  above, 
a  vertex  joining  two  hidden  edges  wiU  have  an  associated  boundary  unless  shortcutting  occurs  all  along  the 
edge.  ♦ 

LEMMA  V-4.7:  The  edges  of  a  high-cost  HCA  with  exterior  goal  are  homogeneous-behavior  boundaries. 

PROOF  V-4.7:Trivially  true.  ♦ 
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LEMMA  V-4.8: Given  a  high-cost  HCA  with  exterior  goal  G,  each  vertex  V  of  a  hidden  edge  generates  a 
linear  shadow  boundary  which  is  the  ray  lying  on  the  line  defined  by  V  and  the  first  point  P  on  OPL(V),  start- 
ing at  V  and  lying  in  the  opposite  direction  from  P. 

PROOF  V-4.8:  The  proof  is  the  same  as  for  Umma  V-1.2.  (See  Figures  23, 24,  and  25.)  ♦ 

LEMMA  V-4.9:Given  a  high-cost  HCA  with  exterior  goal  G  with  n  interior  boundary  trees.  There  exists  an 
opposite-edge  boundary  associated  with  each  tree  which  begins  at  the  point  at  which  an  interior  boundar>'  of 
the  tree  not  associated  with  a  vertex  (i.e.,  not  one  of  the  leaf  nodes  of  the  tree,  see  Figures  30,  3 1 ,  and  32)  in- 
tersects an  edge  of  the  HCA.  There  is  also  an  opposite-edge  boundary  which  begins  at  each  point  at  which  two 
other  opposite-  edge,  or  a  shadow  and  an  opposite-edge  boundary  intersect  An  opposite-edge  boundary  is 
described  by  Equation  1  if  the  interior  boundary  at  which  it  begins  separates  regions  of  two  linearly-traversed 
edges,  or  by  Equation  Set  6  if  the  interior  boundary  at  which  it  begins  separates  regions  whose  paths  cross  two 
edges  en  route  to  the  goal.  If  it  begins  at  the  intersection  of  two  other  exterior  boundaries,  it  will  be  described 
by  Equation  1  if  the  two  regions  which  the  intersecting  boundaries  do  not  have  in  common  have  point  roots, 
and  by  Equation  Set  6  (or  a  degenerate  version)  if  one  of  the  regions  which  the  intersecting  boundaries  do  not 
have  in  common  has  paths  which  cross  two  edges  en  route  to  the  goal. 

PROOF  V-4.9:  At  the  point  at  which  an  interior-boundary  tree  intersects  a  hidden  edge  of  the  HCA  other  than 
a  vertex,  one  of  four  situations  must  exist.  An  optimal  path  from  the  point  of  intersection  may  go  across  the 
HCA  interior  and  a  second  optimal  path  from  the  same  point  travels  along  the  hidden  edge,  for  example,  in 
Figure  30  where  two  of  the  boundaries  labelled  "b"  intersect  edge  V4V5.  Secondly,  one  path  from  the  point  of 
intersection  may  cross  a  visible  edge  and  a  second  path  cross  another  edge,  as  in  the  boundary  labelled  "a"  in 
Figure  30.  Third,  two  paths  may  go  from  the  point  of  intersection  in  opposite  directions  along  the  edge,  as  in 
the  boundary  labelled  "d"  in  Figure  3 1 ,  where  one  path  goes  through  V4  and  one  path  goes  through  V3.  Fourth- 
ly, there  may  be  only  one  optimal  path  from  the  point  of  intersection,  as  in  the  boundar>'  in  Figure  31  that  in- 
tersects edge  V2V3. 
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By  examining  Figures  30  and  31,  it  can  be  seen  that  when  there  are  two  optimal  paths  from  the  point  of 
intersection  of  the  interior  boundary,  there  are  points  in  the  HCA  exterior  which  also  go  in  two  directions, 
forming  a  boundary.  In  the  fourth  case  above,  where  there  is  only  one  optimal  path  from  the  point  of  intersec- 
tion, it  can  be  seen  that  there  is  no  exterior  boundary.  But  the  interior  boundary  in  this  case  is  associated  with 
a  verte  x.  In  the  first  case,  the  exterior  boundary  separates  a  region  whose  points  go  to  the  vertex  of  the  hid- 
den edge  through  which  goes  the  path  from  the  intersection  point,  from  the  region  whose  paths  cross  two  edges 
en  route  to  the  goal.  This  is  a  degenerate  case  of  Theorem  V-0.6,  where  one  path  crosses  two  edges  and  the 
other  path  goes  through  a  point  instead  of  crossing  two  edges,  so  Equation  Set  6  applies.  In  the  second  case, 
the  exterior  boundary  separates  a  region  whose  paths  cross  two  edges  from  a  region  whose  paths  cross  two 
other  edges,  so  Equation  Set  6  applies.  In  the  third  case,  the  exterior  boundary  separates  two  regions  whose 
paths  go  through  points,  as  in  Theorem  V-0.1  and  Equation  1. 

When  any  two  exterior  boundaries  intersect,  it  must  be  that  a  third  opposite-edge  boundary  begins,  be- 
cause past  the  point  of  intersection  there  must  be  a  discrimination  between  the  two  regions  which  the  first  two 
boundaries  did  not  have  in  common.  The  third  boundary  has  as  its  region  roots  either  two  points,  a  point  for 
one  root  and  two  edges  for  the  other,  or  two  different  edges  for  both  roots,  because  these  are  the  only  types  of 
roots  which  the  original  exterior  opposite-edge  boundaries  had.  These  roots  are  described  by  Equation  1  or 
Equation  Set  6,  where  a  degenerate  case  of  Equation  Set  6  is  the  case  that  one  of  the  pair  of  edges  is  replaced 
by  a  vertex.  Figures  30  and  31  show  examples  of  exterior  boundaries  intersecting.  ♦ 

LEMMA  V-4.10:Given  high-cost  HCA  with  exterior  goal  G,  and  vertex  V  joining  a  visible  and  a  hidden  edge 
across  which  shortcutting  occurs.  There  is  a  corner-cutting  boundary  which  begins  at  point  V  and  obeys  the 
degenerate  form  of  Equation  Set  6  where  paths  on  one  side  of  the  boundary  cross  two  edges,  while  paths  on 
the  other  side  go  through  a  vertex. 

PROOF  V-4.10:(See  Figure  31.)  Points  on  the  shadow  boundary  emanating  from  V2  in  Figure  31  (labelled 
"e")  go  through  V2  to  the  goal.  Since  the  HCA  interior  has  a  higher  cost-rale  than  the  exterior,  there  are  some 
points  just  below  the  shadow  boundary  which  will  travel  to  V2  rather  than  go  through  the  HCA.  But  points 
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further  below  the  shadow  boundary  will  have  further  to  go  to  vertex  V2  and  so  will  cross  the  HCA,  paying  the 
higher  cost-rate  to  do  so.  One  set  of  points  lies  in  a  region  with  V2  as  root,  while  the  other  set  of  points  lies  in 
a  region  with  edge  V2V3  as  root.  Paths  in  the  second  region  cross  two  edges  en  route  to  the  goal.  This  con- 
forms to  the  degenerate  form  of  Equation  Set  6.  ♦ 

THEOREM  'V-4:A  high-cost  HCA  with  exterior  goal  has  boundaries  according  to  Lemmas  V-4.1  through 
V-4.10. 

PROOF  V-4:Follows  direcUy  from  Lemmas  V-4.1  through  V-4.10.  ♦ 

LEMMA  V-5.1:Given  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini- 
tially along  an  edge  of  the  HCA,  there  is  a  hidden-edge  boundary  which  begins  at  Vi  and  is  a  line  segment 
conforming  to  Theorem  V-0.3. 

PROOF  V-5.1:(See  Figure  33.)  Assume  that  for  a  vertex  of  high-cost  interior-goal  HCA  Vi,  OPL(Vi)  =  [X, 
G],  where  X  is  a  point  on  HCA  edge  ViVi-i,  for  example  V3  in  Figure  33.  Then  there  will  be  some  points  close 
to  Vi  in  the  HCA  interior  which  will  exit  and  travel  along  edge  ViVi-i  to  X.  Similarly,  there  will  be  some  points 
close  to  Vi  on  edge  Vi+iVi  whose  paths  go  through  Vi,  and  so  there  will  be  points  close  to  Vi  in  the  HCA  in- 
terior which  exit  the  HCA  and  travel  along  edge  Vi+i  Vi  to  V,.  Thus  there  are  two  regions  in  the  vicinity  of  Vi, 
and  the  boundary  between  them  separates  paths  which  enter  a  linearly-traversed  edge  and  travel  along  it  from 
those  which  enter  another  linearly-traversed  edge  and  travel  along  it.  This  is  the  situation  of  Theorem  V-0.3, 
so  the  boundary  is  a  Une  segment  as  described  therein.  ♦ 

LEMMA  V-5.2:Given  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini- 
tially along  an  edge  of  the  HCA,  there  is  a  hidden-edge /goal  boundary  which  is  a  parabola  as  specified  in 
Equation  2  which  separates  points  which  go  to  and  travel  along  edge  Vi Vi+ 1  from  points  which  go  to  and  travel 
along  edge  ViVi-i. 
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PROOF  V-5.2:(See  Figure  33,  boundaries  labelled  "b".)  By  ihe  same  reasoning  as  Lemma  V-5.1,  there  are 
points  close  to  vertex  Vi  which  exit  the  region  and  travel  along  edge  Vi+iVi  to  Vj.  Consider  point  P  which  is 
moved  away  from  Vi  into  the  interior  along  the  hidden-edge  boundary  associated  with  Vi.  At  some  point,  paths 
from  P  which  go  to  edge  ViVi+i  will  cost  no  less  than  a  path  from  P  straight  to  the  goal  at  the  higher  cost  rate. 
At  this  point,  a  new  boundary  begins  separating  points  which  go  to  edge  ViVi+i  and  travel  along  it  to  Vi,  from 
points  which  go  to  G.  This  is  the  same  situation  as  described  in  Theorem  V-0.2,  with  Equation  2  describing 
the  parabolic  boundary.  ♦ 

LEMMA  V-5.3:Given  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini- 
tially along  edge  ViVi-i  of  the  HCA  and  cuts  into  the  HCA  at  some  point  along  edge  ViVi-i,  there  is  a  visible- 
edge/ goal  boundary  which  is  a  parabola  as  specified  in  Equation  2  and  separates  points  which  travel  along  the 
visible  edge  ViVi-i  from  those  which  go  directly  to  the  goal. 

PROOF  V-5.3:By  the  same  reasoning  as  Lemma  V-5.2,  when  point  P  is  far  enough  from  Vi  that  paths  which 
go  to  edge  ViVi-i  cost  no  less  than  a  path  that  goes  directly  to  G  at  the  higher  cost  rate,  a  boundary  will  begin 
separating  points  which  go  to  the  hnearly-tra versed  edge  from  those  which  go  to  the  point  G.  This  is  the  same 
situation  as  described  in  Theorem  V-0.2,  with  parabola  as  described  in  Equation  2.  ♦ 

LEMMA  V-5.4:Given  high-cost  HCA  with  interior  goal  G,  and  two  adjacent  vertices  Vi  and  Vi+i  which  have 
optimal  paths  lying  on  HCA  edges,  neither  of  which  is  edge  ViVi+i.  Then  there  will  be  an  interior-opposite- 
edge  boundary  which  is  a  Une  segment  beginning  on  edge  ViVi+ 1  and  conforming  to  the  description  of  Theorem 
V-0.3. 

PROOF  V-5.4:If  the  optimal  path  from  Vi  lies  initially  on  edge  ViVi-i,  and  the  optimal  path  from  Vi+i  lies 
initially  on  edge  ViVi+i,  as  must  be  by  assumption,  there  will  be  points  in  the  interior  of  the  HCA  as  described 
in  Theorem  V-0.3  which  have  paths  which  go  to  edge  ViVi+i  and  travel  along  it  to  V,,  and  similarly  there  will 
be  points  in  the  interior  which  have  paths  which  go  to  edge  ViVi+i  and  travel  along  it  to  Vi+i.  Where  these 
two  regions  meet,  the  boundary  will  separate  points  whose  paths  go  to  one  linearly-traversed  edge  from  points 
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whose  paths  go  to  another  linearly-  traversed  edge,  the  situation  described  in  Theorem  V-0.3.  Therefore,  the 
boundary  will  be  a  line  segment  as  described  in  Theorem  V-0.3.  ♦ 

LEMMA  V-5.5:Each  edge  of  a  high-cost  HCA  with  interior  goal  will  be  a  hca-edge  boundary. 

PROOF  V-5.5:TriviaUy  true.  ♦ 

LEMMA  V-5.6:Given  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini- 
tially along  an  edge  of  the  HCA  with  OPL(Vi)  =  [X  I  OPL(X)],  there  is  a  shadow  boundary  which  is  a  ray  with 
vertex  V;  and  collinear  with  line  ViX,  which  lies  away  from  X. 

PROOF  V-5.6:The  proof  proceeds  as  in  Proof  V-1.2.  ♦ 

LEMMA  V-SJiGiven  a  high-cost  HCA  with  interior  goal  G,  and  opposite  edge  ViVi+i  as  defmed  in  Lemma 
V-5.4.  Then  an  exterior  opposite-edge  boundary  exists  which  conforms  to  Equation  1. 

PROOF  V-5.7:At  the  point  at  which  the  interior-opposite-edge  boundary  intersects  edge  ViVi+i,  there  are 
two  optimal  paths  which  go  through  vertices  Vi  and  Vi+i.  Points  will  exist  in  the  exterior,  but  close  to  this  in- 
tersection point,  which  will  have  optimal  paths  which  go  through  these  vertices  as  well.  These  points  are  on  a 
boundary  which  separates  points  whose  paths  go  through  Vi  from  those  which  go  through  Vi+i,  two  regions 
with  point  roots.  Therefore,  Theorem  V-0.1  applies,  and  the  boundary  is  a  hyperbola  segment  which  conforms 
to  Equation  1 .  ♦ 

LEMMA  V-5.8:  Given  high-cost  HCA  with  interior  goal  G,  and  vertex  Vi  which  has  optimal  path  which  goes 
directly  to  G.  There  will  be  a  visible-edge  boundary  in  the  HCA  exterior  beginning  at  V,  which  conforms  to 
Equation  Set  4. 

PROOF  V-5.8:Consider  points  close  to  Vi  outside  the  HCA.  Since  the  best  path  from  Vi  is  straight  to  the  goal, 
clearly  paths  from  points  in  the  lower-cost  exterior  will  have  optimal  paths  which  go  directly  to  the  goal  via 
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a  Snell's-Law  path  across  one  of  ihe  edges  incident  upon  Vi.  The  boundary  which  separates  paths  which  cross 
one  edge  from  those  which  cross  the  other  edge  conform  to  the  situation  described  in  Theorem  V-0.4,  and  so 
the  boundary  will  conform  to  Equation  Set  4.  ♦ 

LEMMA  V-5.9:Given  a  high-cost  HCA  with  interior  goal  G  and  vertex  Vi  with  associated  hidden-edge/goal 
boundary  which  intersects  edge  Vi Vi+ 1 .  Then  there  will  be  a  corner-cutting  boundary  which  begins  at  the  point 
of  intersection  and  continues  into  the  exterior  conforming  to  a  degenerate  form  of  Equation  Set  4,  where  one 
edge-crossing  degenerates  to  a  point  crossing. 

PROOF  V-5.9:(See  Figure  33,  boundaries  labelled  "h".)  At  the  point  of  intersection  of  the  hidden-edge/goal 
boundary  with  edge  ViVi+i,  there  are  two  optimal  paths;  one  goes  directly  to  the  goal,  and  the  other  goes 
through  Vi.  A  point  just  outside  the  HCA  in  the  vicinity  of  the  point  of  intersection  may  therefore  have  a  path 
which  goes  to  Vi,  or  which  crosses  edge  ViVi+i  en  route  to  the  goal.  The  boundary  separating  such  points  is 
therefore  a  boundary  between  a  region  which  has  a  point  as  root,  and  one  which  has  an  edge-crossing  as  root. 
This  is  a  degenerate  form  of  the  situation  of  Theorem  V-0.4,  so  Equation  Set  4  applies.  ♦ 

THEOREM  V-5:  Given  a  high-cost  HCA  with  interior  goal,  the  boundaries  associated  with  the  HCA  are  as 
described  by  Lemmas  V-5.1  through  V-5. 9. 

PROOF  V-5:  (See  Figure  33.)  Follows  directly  from  Lemmas  V-5.1  through  V-5.9.* 

LEMMA  V-6.1:Given  a  low-cost  HCA  with  interior  goal  point  G,  there  are  no  boundaries  in  the  HCA  inte- 
rior. 

PROOF  V-6.1:  (See  Figure  34.)  Assume  that  there  is  a  point  P  with  optimal  path  OPL(P)  =  [R  I  OPL(R)],  i.e., 
that  the  path  does  not  go  directly  to  the  goal.  R  must  lie  on  an  edge  or  vertex,  by  Theorem  1-2.  In  either  case, 
the  path  must  be  longer  in  Euclidean  distance  than  the  line  segment  PG,  by  the  triangle  inequality.  Since  the 
interior  cost-raic  is  lower  than  the  exterior  cost-rate,  there  is  no  advantage  to  a  path  to  use  the  exterior  cost- 
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rate,  so  the  cost  of  PG  must  be  less  than  IPRI  +  l(RG)*l,  which  is  a  contradiction.  Therefore  all  interior  points 
have  the  path  list  [G].  By  the  definition  of  a  homogeneous-behavior  region,  the  entire  HCA  interior  is  a  single 
region,  so  there  are  no  interior  boundaries.  ♦ 

LEMMA  V-6.2:  Given  a  low-cost  HCA  with  interior  goal  G.  From  each  vertex  V  there  are  two  vertex/edge- 
crossing  boundaries  separating  points  whose  optimal  paths  go  through  V  and  then  to  G  from  those  which  cross 
an  edge  obeying  Snell's-Law  and  then  go  to  G.  Each  boundary  lies  on  the  the  path  from  G  through  V  which 
obeys  SneU's  Law  for  crossing  one  of  the  edges  incident  upon  V. 

PROOF  V-6.2:(See  Figure  34.)  Consider  a  point  P  in  the  HCA  exterior  arbitrarily  close  to  the  exterior  leg  of 
a  Snell's-Law  path  from  G  through  V  with  respect  to  edge  E.  The  optimal  path  from  P  goes  through  edge  E 
obeying  Snell's  Law.  By  the  principle  of  optimality  (Theorem  I-l),  all  points  along  that  path  also  have  optimal 
paths  which  lie  on  the  same  path.  Thus,  the  boundary  is  a  ray  lying  at  the  angle  prescribed  by  Snell's  Law.  ♦ 

THEOREM  V-6:Given  a  low-cost  HCA  with  interior  goal.  The  interior  has  no  boundaries,  and  the  exterior 
boundaries  are  as  described  in  Lemma  V-6. 1 . 

PROOF  V-6:Follows  directly  from  Lemmas  V-6.1  and  V-6.2.  ♦ 

LEMMA  V-7.1:Given  a  low-cost  HCQ  with  exterior  goal,  each  edge  is  an  hca-edge  boundary. 

PROOF  V-7.1:Trivially  true.  ♦ 

LEMMA  V-7.2:Given  low-cost  HCA  with  exterior  goal  G  and  vertex  V  such  that  the  optimal  path  from  V 
goes  initially  into  the  HCA  interior.  Then  a  veriex/edge-crossing  boundary  exists  for  each  edge  incident  upon 
V  which  is  the  second  leg  of  a  path  from  G  through  V  which  obeys  Snell's  Law  with  respect  to  the  edge,  and 
separates  paths  starting  in  the  exterior  which  go  through  V  from  paths  which  cross  the  edge.  If  the  optimal 
path  from  V  goes  initially  along  an  edge  of  the  HCA,  one  such  boundary  exists  with  respect  to  the  edge  inci- 
dent upon  V  not  travelled  by  the  path  from  V. 
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PROOF  V-7.2:  (See  Figxire  35.)  The  same  reasoning  as  in  Proof  V-6.2  applies  here.  ♦ 

LEMMA  V-7.3:Given  low-cost  HCQ  with  exterior  goal  G,  interior  cost-rate  n,  exterior  cost-rate  re,  and  ver- 
tex V  such  that  the  optimal  path  from  V  goes  initially  along  an  edge  of  the  HCA  incident  up)on  V.  Then  a  ver- 
lexl  edge -following  boundary  exists  which  is  a  ray  from  V  along  a  line  which  makes  the  angle  7C/2  +  6c  with 
the  edge,  where  9c  =  sin'  (ri/re). 

PROOF  V-7.3:  (See  Figure  35.)  The  analysis  is  the  same  as  Proof  V-6.2  above.  ♦ 

LEMMA  V-7.4:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  ini- 
tially along  an  edge  of  the  HCA.  There  is  a  parabolic  edge-following/ goal  boundary  which  begins  along  the 
edge,  conforms  to  Equation  2,  and  separates  paths  which  go  to  the  edge  and  follow  it,  from  paths  which  go 
directly  to  the  goal. 

PROOF  V-7.4:  (See  Figure  35.)  The  proof  is  the  same  as  for  the  near-side-road-  travelhng/goal  boundary  for 
road  segments  in  Proof  V-3.4.  ♦ 

LEMMA  V-7.5:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  such  that  the  optimal  path  from  V 
lies  along  an  edge  of  the  HCA  incident  upon  V.  Then  there  is  a  hyperbolic  vertex/ goal  boundary  which  con- 
forms to  Equation  1,  and  separates  paths  which  go  through  V  from  those  which  go  directly  to  G. 

PROOF  V-7.5:  (See  Figure  35.)  The  proof  is  the  same  as  for  road-end/goal  boundary  of  road  segments.  Proof 
V-3.3.* 
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LEMMA  V-7.6:Given  a  low-cost  HCA  with  exterior  goal  and  vertex  Vi  such  that  the  optimal  path  from  Vi 
lies  in  the  HCA  interior,  and  vertex  Vi-i  adjacent  to  Vi  and  closer  to  G.  A  edge-crossing/goal  will  exist  if  the 
vertex/goal  boundary  associated  Vi-i  intersects  the  both  vertex/edge-following  boundaries  emanating  from  Vi- 
1.  It  will  conform  to  a  degenerate  form  of  Equation  Set  6,  and  separate  paths  which  cross  edge  ViVi-i  and  then 
cross  a  visible  edge  en  route  to  the  goal,  from  paths  which  go  straight  to  the  goal. 

PROOF  V-7.6:  (See  Figure  35.)  At  the  point  at  which  the  hyperbolic  vertex/goal  boundary  intersects  the  ver- 
tex/edge-following boundary  associated  with  edge  ViVi-i ,  the  two  regions  not  common  to  the  boundaries  are 
the  one  whose  paths  go  straight  to  the  goal,  and  the  one  whose  paths  cross  the  edge  en  route  to  a  second  edge 
crossing,  and  the  goal.  But  this  is  the  form  of  Theorem  V-0.6,  where  one  pair  of  edge-crossings  degenerates 
to  a  single  point-  crossing.  Thus  Equation  Set  6  appUes.  ♦ 

LEMMA  V-7.7:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  direct- 
ly to  the  goal,  such  that  V  is  not  incident  to  any  other  homogeneous-behavior-region  boundaries.  There  is  a 
visible-  edge  boundary  in  the  HCA  interior  which  begins  at  V  and  continues  across  the  HCA  to  a  hidden  edge. 

PROOF  V-7.7:Consider  points  inside  the  HCA  near  V.  The  path  from  such  a  point  crosses  one  edge  incident 
upon  V  or  the  other  (See  Figure  35).  Therefore,  there  are  two  regions  inside  the  HCA,  and  the  boundary 
separates  the  two.  Since  the  region  roots  are  both  edges  crossed  by  paths.  Theorem  V-0.4  applies,  so  the  bound- 
ar>'  conforms  to  Equation  Set  4.  ♦ 

LEMMA  V-7.8:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  direct- 
ly to  the  goal,  such  that  V  is  not  incident  to  any  other  homogeneous-behavior-region  boundaries,  and  given 
the  visible-  edge  boundary  in  the  HCA  interior  as  specified  in  Lemma  V-7.7.  There  is  an  opposite-edge  bound- 
ary in  the  HCA  exterior  which  begins  at  the  point  of  intersection  of  the  visible-edge  boundary  with  the  hidden 
edge  and  conforms  to  Equation  Set  6. 
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PROOF  V-7.8:  At  ihe  point  of  intersection  of  the  visible-edge  boundary  with  the  hidden  edge,  there  are  two 
optimal  paths,  which  cross  the  two  edges  incident  upon  V.  Points  in  the  HCA  exterior  near  this  point  of  inter- 
section will  cross  into  the  HCA  interior,  crossing  on  one  side  or  the  other  of  the  point  of  intersection.  Points 
which  cross  on  one  side  will  traverse  the  HCA  interior  and  cross  one  of  the  edges  incident  upon  V,  while  points 
which  cross  on  the  other  side  will  cross  the  other  edge  incident  upon  V.  Therefore,  the  boundary  which  separates 
points  with  these  two  behaviors  conforms  to  Equation  Set  6.  ♦ 

THEOREM  V-7:Given  a  low-cost  HCA  with  exterior  goal,  boundaries  are  generated  according  to  Lemmas 
V-7.1  through  V-7.8. 

PROOF  V-7:Follows  directly  from  Lemmas  V-7.1  through  V-7.8.  ♦ 
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APPENDIX  B  -  POINT-TO-POINT  WAVEFRONT  PROPAGATION 

ALGORITHM 


algorithm  wavefront-propagation 

input:  Start-Point,  Goal-Point 

{ 

Wavefront  :=  Start-Point; 

whUe  (Status  =  INPROGRESS) 

expand-wavefront(Wavefront); 
if  (Status  =  DONE) 

Optimal-Path  :=  Goal-Point  concatenated 
with  back-path(Goal-Point); 
else 

Optimal-Path  is  undefined; 

} 


(Algorithm  B-1) 


/*  iteratively  expand  wavefront  until  */ 
/*  status  is  DONE  or  NIL  */ 


/*  status  is  NIL,  so  no  feasible  solution  */ 
/*  end  of  wavefront-propagation  */ 


procedure  expand -wavefront 
input:  Wavefront 

( 

if  (Wavefront  is  empty) 

Status  :=  NIL; 
else 

{ 

Current-Cell  :=  cell  on  Wavefront  with  min  remaining  cost; 

expand-cell(Current-Cell); 

if  not  (Status  =  DONE) 

{ 

Rest-of- Wavefront  :=  Wavefront  less  Current-Cell; 


/*  Base  case  of  recursion.  If  empty  at  1st  call  */ 
/*  to  expand-wavefront,  there  is  no  feasible  path  */ 


expand-wavefront(Rest-of- Wavefront); 

ifnot  (Status  =  DONE) 

{ 

Wavefront  :=  Cells-for-New-Wavefront 

appended  onto  front  of  Wavefront; 
Status  :=  INPROGRESS; 


} 


/*  recursive  call  to  expand-wavefront  */ 


/*  Note:  Wavefront  is  recursively  emptied  */ 
/*  out  level  by  level  and  new  Wavefront  */ 
/*  is  built  up  as  each  level  returns.  */ 


/*  end  of  expand-wavefront  */ 
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/*  initialize  flag  to  assume  that  Current-Cell  */ 
/*  will  not  stay  on  Wavefront  */ 


procedure  expand -cell 
input:  Current  Cell 

{ 

Finished-With-Cell  :=  TRUE; 

Cells-for-New-Wavefront  :=  empty  list; 

for  (New-Cell  :=  North-,  East-,  South-,  and  West-Neighbor) 

orthogonaI-expand(Current-CeIl,New-CeIl); 
for  (New-Cell  :=  Northeast-,  Southeast-,  Southwest-,  and  Northwest-Neighbor) 

diagonal-expand(Current-Cen,New-Cell); 
if  not  (Finished-With-Cell)  /*  keep  Ciurent-Cell  on  Wavefront  */ 

Cells-for-New-Wavefront  :=  Current-Cell  appended 
onto  Cells-for-New-Wavefront; 
if  (Cells-for-New-Wavefront  contains  Goal-Point) 

Status  :=  DONE; 
else 

Status  :=  INPROGRESS; 
)  /*  end  of  expand-cell  */ 


procedure  orthogonal-expand 
input:  Current-Cell,  New-Cell 

{ 

if  ((Parent-Pointer-of-New-Cell  is  not  yet  set) 
or  (Parent-Pointer-of-New-Cell  =  Current-Cell) 
*/      or  ((Initial-Cost-of-New-Cell  -  1.414) 
<  Cost-of-New-CeU)) 

{ 

Parent-Pointer-of-New-Cell  :=  Current-Cell; 
Cost-of-New-CeU  :=  Cost-of-New-Cell  -  1.414; 
if(Cost-of-New-CeU<0) 

{ 

overnow(Current-CelI,  New -Cell); 

Cells-for-New-Wavefront  :=  Overflow-List 
appended  onto  New-Cell; 

} 
else 

{ 

Cells-for-New-Wavefront  :=  empty  list; 

Finished-With-Cell  :=  FALSE; 


] 


) 


/*  if  this  is  first  cell  to  expand  into  New-  */ 
/*  Cell,  or  this  path  costs  less  to  expand  into  */ 
/*  New-Cell,  set  backpointer  and  explore  New-Cell. 


/*  Current-Cell  becomes  parent  of  New-Cell.  */ 
/*  decrement  cost  of  New-Cell  */ 

/*  if  New-Cell  has  been  fully  explored,  */ 
/*  then  New-Cell  and  possibly  an  overflow  */ 
/*  cell  are  added  to  new  Wavefront  */ 


/*  if  New-Cell  has  not  been  fully  explored,  */ 
/*  New-Cell  is  not  added  to  new  Wavefront  */ 
/*  but  reset  the  flag  to  note  that  */ 
/*  Current-Cell  must  stay  on  Wavefront  */ 

/*  end  of  orthogonal-expand  */ 
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procedure  diagonal-expand 
input:  Current-Cell,  New-Cell 

{ 

if  ((Parent-Pointer-of-New-Cell  is  not  yet  set) 
or  (Parent-Pointer-of-New-Cell  =  Current-Cell) 
*/      or  ((Initial-Cost-of-New-Cell  - 1 .0) 
<  Cost-of-New-Cell)) 

{ 

Parent-Pointer-of-New-Cell  :=  Current-Cell; 

Cost-of-New-CeU  :=  Cost-of-New-Cell  - 1.0; 

if(Cost-of-New-CeU<0) 

Cells-for-New-Wavefront  :=  Cells-for-New- 
Wavefront  appended  onto  New-Cell; 
else 

{ 

Cells-for-New-Wavefront  :=  null  list; 
Finished-With-Cell  :=  FALSE; 


} 


) 


} 


/*  if  this  is  first  cell  to  expand  into  New-  */ 
/*  Cell,  or  this  path  costs  less  to  expand  into  */ 
/*  New-Cell,  set  backpointer  and  explore  New-Cell. 


/*  Current-Cell  becomes  parent  of  New-Cell.  */ 
/*  decrement  cost  of  New-Cell.  */ 
/*  if  New-Cell  is  fully  explored,  */ 
/*  add  it  to  new  Wavefront.  */ 


/*  if  New-Cell  is  not  fully  explored,*/ 

/*  do  not  add  it  to  new  Wavefront  */ 

/*  and  reset  flag  to  insure  that  Current-Cell  */ 

/*  gets  put  back  on  Wavefront.  */ 

/*  end  of  diagonal-expand  */ 


procedure  overflow 

input:  Current-Cell,  New-Cell 

{ 

Overflow-Cell  :=  cell  on  opposite  side  of  New-Cell  from  Current-Cell; 

if  ((Parent-Pointer  of  Overflow-Cell  is  not  yet  set) 

or  (Parent-Pointer  of  Overflow-Cell  =  New-Cell) 

or  ((Initial-Cost-of-New-Cell  - 1.0) 
<  Cost-of-New-Cell)) 

{ 

Parent-Pointer  of  Overflow-Cell  :=  New-Cell; 

Cost  of  Overflow-Cell  :=  Cost  of 

Overflow-Cell  +  (Cost  of  New-Cell); 
if  (Cost  of  Overflow-Cell  <  0) 


{ 

overflowOVew-Cell,  Overflow-Cell); 

Overflow-List  :=  Overflow-List 
appended  onto  Overflow-Cell; 

) 
else 

Overflow-List  :=  empty  list; 

} 
else 

Overflow-List  :=  empty  list; 
) 


/* 
/* 
/* 
/* 


Current-Cell  becomes  parent  of  New-Cell.  */ 
decrement  Overflow-Cell  by  the  negative  */ 
amount  left  over  from  New-Cell.  */ 
if  necessary,  call  overflow  again.  */ 


/* 
/* 

/* 
/* 
/* 


else  Overflow-Cell  is  not  */ 
added  to  new  Wavefront.  */ 

if  Overflow-Cell  already  has  */ 
a  parent,  do  nothing.  */ 
end  of  overflow  */ 
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APPENDIX  C  -  WAVEFRONT-PROPAGATION  OPM  CONSTRUCTION 

SOURCE  CODE 

******************************************************************** 
******************************************************************** 

*****  "opm"  creates  an  optimal  path  map  by  finding  the  boundaries 

*****  between  regions  of  similarly-behaved  optimal  paths  using  the 

*****  wavefront  propogation  algorithm.   The  basic  structure  of  the 

*****  wavefront  algoritlim  used  is  adapted  from  a  Prolog  program 

««•**  i^y  f^j  BQb  Richbourg,  June  87. 

*****  xhis  is  the  "pure"  version  which  tests  for  boundaries  by  checking 

*****  for  the  equivalent  turn-j)oint3  in  the  optimal-path  list  of 

*****  neighboring  cells. 

***** 

*****  Current  as  of  27  Jun  89 
***** 

*****  Input:  files  "declar",  "initmap",  "utils",  "bdry",  &  "graphics". 
*****  Output:  Graptiical  output  to  tlie  host  Symljolics  screen. 

******************************************************************** 
******************************************************************** 

******************************************************************** 
*****  function  "opm"  is  the  top-level  function  of  file  opm. lisp 
*****    Arguments:  none 
*****    Returned:  T. 

*****    Side  Effects:  sets  *boundary*  array  with  the  pixels  which 
*****      represent  region  boundaries. 

*****    Functions  Used:  initial! ze-map,  init iali ze-graphi cs, 
*****      expand-wavef ront ,  draw-and-show-windows, 
*****      draw-and-show-bdry-window,  kill-windows, 
*****      and  report-completion, 
(defun  opm  () 

(setf  * internal-t imel *  (get-internal-run-time)) 

(setf  *external-t imel *  (qet-univer sal-time) ) 

( init  ial ize) 

(princ  "Init  Process  Time:  ") 

(prinl  (-  (setf  *internal-t ime2 *  (get-internal-run-t ime) )  * internal-t imel *) ) 

(linefeed) 

(princ  "      Elapsed  Time:  ") 

(prinl  (-  (setf  *external-time2*  (get-universal- time) )  *external-t imel * ) ) 

( linefeed) 

(do  ((Wavefront  (list  *goal*) 

(expand-wavef ront  Wavefront) ) ) 
(  (null  Wavefront)  )  ) 
;      (draw-and-show-window)  ) 

(cond  ((equal  nil  *  increment al-bdry-clieck* )   (check-all-boundaries))) 

(princ  "  Expansion  Process  Time:  ") 

(prinl  (-  (setf  *  inter nal-t imel *  (get-internal-run-time))  *  inter nal-time2 *)  ) 

( 1 inef eed) 

(princ"  Elapsed    Time:     ") 

(prinl     (-     (setf    *er.ternal-timel  *     (get-universal- time)  )     *exter nal-Lime2*  )  ) 

( 1 i  nef eed) 

(draw-and-show-bdry-window) 

(cond     ((null    * incremental-bdry-check* )      (  show-backpaths )  )  ) 

(report-completion) ) 

A********************************************************************* 

****  function  initialize  loads  files,  preprocesses  the  map,  and 
****    initializes  the  qrapliic."3  screen, 
(defun  initialize  () 
(load  "declar") 
(load  "initmap") 
(loar!  "utils") 
(load  "bdry") 
(load  "graphics") 
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( i  n  i  t  i  a  1  i  2  e  -  m  a  p ) 

(initialize-graphics) 

(princ  "Beginning  Wavefront  Expansion")  (linefeed)  (linefeed)) 

;*****  Function  expand-wavef ront :  computes  the  next  wavefront  by  taking 
.****«  the  first  pair  of  cell  coordinates  from  the  wave 

.*****  ap(j  processing  it,  then  recursively  processing 

.*****  the  rest  of  the  list  in  the  same  manner. 

.*****    Argument:  Wave,  the  remainder  of  the  old  wavefront  left  to  process 
.****«    Returned:  the  new  wavefront,  or  nil  if  Wave  becomes  empty 
.*****    Side  Effects:  see  below 

.*****    Functions  Used:  expand-cell  and  expand-wavef ront 
(defun  expand-wavef ront  (Wave) 
(cond  ((null  Wave)  nil) 

(t  (append  (expand-cell  (car  Wave) ) 

(expand-wavef ront  (cdr  Wave) ) ) ) ) ) 

*********************************************************************** 

*****  Function  expand-cell:  determines  which  of  the  eight  neighboring 

*****  cells  will  be  on  the  new  wavefront  and  whether  there  is  a 

*****  region  boundary  around  the  center  cell. 

*****  Argument:  Cell,  a  list  of  the  X,Y  coords  of  the  cell  on 

*****  the  current  wavefront  being  processed. 

*****  Returned:  A  list  of  cells  to  be  added  to  the  new  wavefront 

*****  Side  Effects:  none 

*****  Functions    Used:    orthog-expand,    diag-e:tpand 

***** 

(defun  expand-cell  (Cell) 

(setq  * f inished-with-cel 1-p*  't)     ;  initialize  flag  -  assume 

;  cell  will  not  stay  on  wf 
(cond  ((not  (null  *incremental-bdry-check* ) )   (chec)t-f or-boundar ies  Cell))) 
(let*   ( (X  (car  CelJ ) ) 
(Y  (cadr  Cell) ) 
(Cells-to-add 
(nrever se 

(remove  nil 
(append 

(orthog-expand  (list  X  (1+  Y))  (list  X  Y)) 
(orthog-expand  (list  (1+  X)  Y)   (list  X  Y)) 
(orthog-expand  (]ist  X  (1-  Y)  )   (list  X  Y)  ) 
(orthog-expand  (list  (1-  X)  Y)   (list  X  Y) ) 
(diag-expand  (list  (1-  X)   (1+  Y))   (list  X  Y) ) 
(diag-expand  (list  (II  X)   (1+  Y))   (list  X  Y) ) 
(diag-expand  (list  (1+  X)   (1-  Y) )   (list  X  Y) ) 
(diag-expand  (list  (1-  X)   (1-  Y))   (list  X  Y))*)))) 
(cond 

((null  * f inished-with-cel 1-p* )     ;  If  some  neighbors  are  not  fully 

(cons  (list  X  Y)  Cells-to-add))   ;  explored,  leave  center  cell  on  wf 
(t  Cells-to-add) ) ) ) 

***********«*****^***************************************************** 

*****  Function  diag-expand:  explores  a  cell  which  is  in  a  diagonal 
*****        direction  from  the  cell  being  expanded. 
*****    Arguments:  same  as  orthoo-expaiid 

*****    Returned:  A  list  consisting  of  a  list  of  cells  to  be  added  to 
*****       the  new  wavefront  and  a  flag  to  note  that  (1)  Center-cell 
*****       has  fully  explored  its  neighbor,  or  (0)  it  has  not. 
*****    Side  Effects:  Sets  the  parent  coords  of  New-cell  if  tliey  are  nil 
(defun  diag-expand  (Hew-cell  Center-cell) 
(let  ( (Xn  (car  New-cell ) ) 

(Yn  (cadr  New-cell) ) 

(Xc  (car  Center-cell)) 

(Yc  (cadr  Center-cell))) 
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(cond  ((null  (aref  *cell*  Xn  Yn  1)) 
(setf  (aref  *cell*  Xn  Yn  1) 

Center-cell)  ; 

(set-opl  Xn  Yn  Xc  Yc) 
(setf  (aref  *cell*  Xn  Yn  0) 

(-  (aref  *cell*  Xn  Yn  0)  1)) 
(cond  ( (<=  (aref  *cell*  Xn  Yn  0)  0) 
(setq  *bac)cpath-pixel-list  * 
(append 

(qet-backpath  Xn  Yn) 
*backpath-pixel-li3t* )  ) 
(list  New-cell) ) 
(t  (setq  *  f  inished-witli-cell-p* 
nil) ) )) 


If  New-cell  not  explored 
yet,  and  is  not  an  obstacle. 
Center-cell  becomes  its  parent 
Set  Opt-Path-List  for  (Xn, Yn) 
;  Decrement  cost 

If  Newcell  is  fully  explored 


((and  (=  Xc  (car  (aref  *cel]*  Xn  Yn  1) 
(=  Yc  (cadr  (aref  *cell*  Xn  Yn  1 
(>  (aref  *cell*  Xn  Yn  0)  0)) 
(setf  (aref  *cell*  Xn  Yn  0) 

(-  (aref  *cell*  Xn  Yn  0)  1) ) 
(cond  ((<=  (aref  *cell*  Xn  Yn  0)  0) 
(setq  *backpat h-pixel-list * 
(append 

(get-backpath  Xn  Yn) 
*backpat h-pixel-list * ) ) 
(list  New-cell) ) 
(t  (setq  * f inished-with-cell- 
nil)))) 


add  its  parent  to  the 
display  list  of  parents 
and  add  New-cell  to  wave. 
;  If  New-cell  is  not  fully 
;  explored,  don't  add  to  wf, 
;  and  note  that  Center-cell 
;  must  stay  on  wavef ront . 
))      ;  If  Newcell' 3  parent  is 
) ) )     ;  Center-cell  and  Newcell 
;  not  fully  explored, 

;  Decrement  cost . 

;  If  N^iwcell  is  fully  explored 

;  Add  parents  to  the 
;  backpath  display 


(t  nil) ) ) ) 


Add  current  new  cell  to  wf 
;  If  New-cell  is  not  fully 
;  explored  don't  add  it  to 
;  wf,and  note  that  Center 
;  must  stay  on  wavef ront . 
If  Newcell  was  already  explored,  don't  add  to  wave. 


*  -k  *  *  * 

*  *  *  *  * 

*  *  A  *  * 

*  *  *  *  * 

*  *  *  *  * 

*  *  i>  *  * 

*  *  *  *  * 
A  A  A  A  A 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

*****  Function  or t hog-expand :  explores  a  cell  which  is  in  an  ortliogonal 
direction  from  the  cell  being  expanded. 
Arguments:  the  first  argument  is  a  list  of  the  X,Y 

coords  of  the  cell  being  explored;  the  second  is  a  list 
of  coordinates  of  the  cell  on  the  current  wavefront 
being  expanded  from. 
Returned:  A  list  of  two  elements:  the  first  is  a  list  of 

new  cells  to  be  added  to  the  new  wavefront  and  the  second 
is  a  flag  set  as  indicated  above  (in  diag-expand) 
Side  Effects:  Sets  the  parent  coords  of  New-cell  if  they  are  nil 
(defun  orthog-expand  (New-cell  Center-cell) 
(let  ( (Xn  (car  New-cell)) 
(Yn  (cadr  New-cell) ) 
(Xc  (car  Center-cell)) 
(Yc  (cadr  Center-cell) ) ) 
(cond  ((null  (aref  *cell*  Xn  Yn  1)) 
(setf  (aref  *cell*  Xn  Yn  1) 

Center-cell)  ; 

(set-opl  Xn  Yn  Xc  Yc) 
(setf  (aref  *cell*  Xn  Yn  0) 

(-  (aref  *cell*  Xn  Yn  0)  1.414)) 
(cond  ( (<=  (aref  *cell*  Xn  Yn  0)  0) 
(setq  *backpath-pixel-list * 
(append 

(qet-backpath  Xn  Yn) 
*backpat h-pixel-list * ) ) 
(append  (overflow 

New-cell 
Center-cell) 
(list  New-cell) ) ) 


If  New-cell  not  explored 
yet,  and  is  not  an  obstacle. 
Center-cell  becomes  its  parent 
Set  Opt-Patli-List  for  (Xn,  Yn) 
;  Decrement  cost 

If  New-cell  is  fully  explored 


Add  its  parent  to  the 
display  list 

Explore  next  cell  in  dir- 
ection of  expansion  &  add 
any  overflow  cells. 
Add  current  new  cell  to  wf 
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(t  (setq  * f inished-with-cell-p* 
nil)  nil))) 


((and  (=  Xc  (car  (aref  *cell*  Xn  Yn  1))) 
(=  Yc  (cadr  (aref  *cell*  Xn  Yn  1))) 
(>  (aref  *cell*  Xn  Yn  0)  0)) 
(setf  (aref  *cell*  Xn  Yn  0) 

(-  (aref  *cell*  Xn  Yn  0)  1.414)) 
(cond  ( (<=  (aref  *cell*  Xn  Yn  0)  0) 
(setq  *bac)cpath-pixel-list  * 
(append 

(get-backpath  Xn  Yn) 
*bac)cpath-pixel-liat  * )  ) 
(append  (overflow  ; 

New-cell  ; 

Center-cell)        ; 
(list  New-cell) ) ) 

(t  (setq  * f inished-with-cell-p* 
nil)  nil))) 


(t  nil) ) ) ) 


If  Newcell  was  already 


to  right  of  overflow  cells. 
;  Else  if  Newcell  not 
;  fully  explored  don' t  add 
;  it  to  wf,and  note  that 
;  Center-cell  stays  on  wf. 

;  If  Newcell' s  parent  is 

;  Center-cell: 

;  Decrement  cost . 

;  If  Newcell  is  fully  explored 

;  Add  parents  to  the 
;  bac)cpath  display 

Explore  next  cell  in  dir- 
ection of  expansion  S  add 
any  overflow  cells. 
Add  current  new  cell  to  wf 
;  to  right  of  overflow  cells. 
;  If  New-cell  is  not  fully 
;  explored  don' t  add  it  to 
;  wf,and  note  that  Center 
;  must  stay  on  wavef rout . 
explored,  don't  add  it  to  wf. 


>  A  A  *  A  A 
,  A  A  *  A  A 

>  A  A  A  A  A 
•  A  A  A  A  A 

■  A  A  A  A  A 

.  A  A  A  A  A 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

determines  whether  expansion  should  continue 


Function  overflow:  determines  whether  expansion  should  cont 
into  the  next  cell  in  the  (orthogonal)  direction  in  which 
it  has  been  going,  and  expands  if  necessary. 

Arguments:  the  first  is  a  list  of  the  X,  Y  coords  of  the  cell 
into  which  the  wave  will  overflow;  the  second  is  the  coords 
of  tlie  cell  from  which  it  overflowed. 

Note  that  Center-cell  in  this  function  is  the  variable 
called  New-cell  in  orthoq-expand,  and  Parent-cell  here  is 
called  Center-cell  in  orthog-expand . 
Peturned:  A  list  of  cells  to  add  to  wavefront 
Side  Effects:  cell  costs  are  decremented 
defun  overflow  (Center-cell  Parent-cell) 
(let*  ( (Xc  (car  Center-cell)) 
(Yc  (cadr  Center-cell)) 


.  A  A  A  A  A 

>  A  A  A  ft  A 

•  A  A  A  A  A 

.  A  A  A  A  A 


(Xp  (car  Parent-cell) ) 
(Yp  (cadr  Parent-cell)) 
(Xn  (+  Xc  (-  Xc  Xp) ) ) 
(Yn  (+  Yc  (-  Yc  Yp) ) ) 
(New-cell  (list  Xn  Yn) ) 
(overflow-cost 


Explore  the  next  cell  in  the  direction 
of  the  previous  expansion 


(cond  (  (null  (aref  *cell*  Xn  Yn  0)  )  0) 

(t  (+  (aref  *cel2*  Xc  Yc  0) 

(aref  *cell*  Xn  Yn  0) ) ) ) ) ) 
(cond  ((null  (aref  *cell*  Xn  Yn  1)) 
(setf  (aref  *cell*  Xn  Yn  1) 

Center-eel 1 ) 
(set-opl  Xn  Yn  Xc  Yc) 
(setf  (aref  *cell*  Xn  Yn  0) 

overflow-cost ) 
(cond  ((<  overflow-cost  0) 

(setq    *bac)'.pat)i-pixel-list  * 
(apperKi 

(get -bac)<pat  h  Xn  Yn) 
*bac)^path- pixel- list*)  ) 


Check  if  overflow  is  at 
a  boundary; 

if  not , decrement  overflow 
cell  by  tlie  (negative) 
amount  left  over  from 

,  ,  ,  ,      ,  previous  cell  . 

If  overflow  cell  is  une-':plored. 

Set  overflow  cell  parent 

to    tlie    explored    cell. 

Set  Opt-Path-List  for  (Xn, Yn) 


Add  parent  to  the 
backpath  display. 
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(append  (overflow 

New-cell 
Center-eel  1 ) 
(list  New-cell) ) ) 
(t  nil) ) ) 
(t  nil)  )  )  ) 


:  If  more  overflow,  expand  again, 
and  add  Newcell  to  wave  list  . 


;  Else  put  nothing  on  wavefront, 
Else  put  nothing  on  wavefront. 
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■*-    Mode:     LISP;     Syntax:     Conmion-Lisp;     Package:    USER 


*  *  *  *  * 

*  *  *  *  * 

*  «  *  *  * 
**  *  *  * 

A  A  A  A  * 

.  *  *  A  A  A 

I  A  A  A  A  A 

•  A  A  A  A  A 
.  A  A  A  A  A 

•  A  A  A  A  A 
>  A  A  A  A  A 

•  A  A  A  A  A 
■  A  A  A  A  A 


AAAAAAA*AAAAAAAAAAAAAAAAAAAAAA*A***AAAAAAAAAAAAA**A*AAAAAAAAAAA 
AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

"declar"  contains  the  declarations  of  global  variables  used 
by  "opm" .   It  is  loaded  by  function  "opm"  in  file  "opm.lisp". 
This  version  is  for  use  with  maps  in  the  form  of  a  rectangle 
of  characters . 

Current  as  of  7  Jun  89 

Side  Effects:  initialization  of  *cell*  and  *boundary*  arrays, 
and  other  global  variables  as  listed  below. 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 


AAAAA  Global  Variables; 


(defvar  *version*) 

;(setf  *version*  "pure")  (setf  * vertex-list  *  nil)  (setf  *edge-list*  nil) 

(setf  *version*  "vertex-edge") 

;  (setf  *version*  "diverging-path" )  (setf  'vertex-list*  nil)  (setf  *edge-list*  nil) 


(defvar  *  increment a 1-bdry-check* ) 

(setq  *incremental-bdry-chec)c*  't) 

(defvar  *  internal -t imel * ) 

(defvar  *external-t imel * ) 

(defvar  *internal-time2* ) 

(defvar  *external-time2* ) 

(defvar  *map-width*) 

(setq  *map-width*  205) 

(defvar  *map-length* ) 

(setq  *map-lengtli*  155) 

(defvar  *magni f ication* ) 

(setq  *magnif ication*  3) 

(defvar  *  river-cost  * ) 

(setq  *river-cost*  16) 

(defvar  *road-cost*) 

(setq  *road-cost*  0.1) 

(defvar  *mapline*) 

(setf  *mapline* 

(make-array 
(list  *map-length* ) ) ) 
(defvar  *ter rain-pixel-list  * ) 
(setq  *terrain-pixel-list *  nil) 
(defvar  *boijndary-pixel-list  *  ) 
(setq  *bout)dary-pixel- list  *  nil) 
(defvar  *backpath-pixel-list * ) 
(setq  *backpat h-pixel-list *  ni]) 
(defvar  *fini  shed-wit  )i-cell-p*) 
(defvar  'output -strean\*  ) 
(defvar  *goal * ) 
(defvar  *cell*) 
(setf  *cell* 

(make -array 
(list 

'map-widt  h* 

*inap-lengt  h  * 

4)  )  ) 


.AAAAA  gg(-  J- q  '  ^^  ^f    che  ck  "bounda  r  i  e  s  should 
.AAAAA  ijg  done  at  each  expand-cell,  nil  if  not 


.AAAAA  Max  allowable  number  of  columns  in  the 
;        map  +  2  for  bordering  columns  of  blanks 

.AAAAA  Max  allowable  number  of  lines  in  the 

map  (=153)  +  2  (=155)  for  the  bordering  lines  of  blanks 

.AAAAA  Magnification  of  the  screen. 

.AAAAA  Cost  to  cross  a  river 

.AAAAA  Cost  to  use  a  road 


AAAAA 


Array  to  hold  the  input  map:  each  element 
is  a  string,  eacli  of  whose  characters 
represents  one  cell  of  the  map. 


AAAAA 
AAAAA 


List  to  hold  coordinates 
of  terrain  pixels. 

List  to  )iold  coordinates 
of  boundary  pixels. 

List  to  hold  coordinates 
of  backpath  pixels. 

Flag  to  record  if  cell  stays  on  wave. 

Can  be  used  to  define  output  stream 
coordinates  of  goal  point 

3-dimp'n  array  whose  first  and  second  indices 
are  the  cell  coordinates  and  whose  third  index 
specifies  the  attribute: 

Attribute  0  is  cost  to  traverse  the  cell, 
decremented  as  wave  passes  over  cell. 
Attribute  ]  is  list  of  parent's  coords 
if  specified,  nil  if  not. 
Attribute  2  is  list  consisting  of  the 
cliaracter  symbol  of  th^  eel],  followed  if 
if  applicable  by  an  edge  id  and  vert<=>x  flag 
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(defvar  *boundary*) 
(setf  'boundary* 
(make-array 
(list 

*map-width* 
*map-lengt h* 
2) 

: element-type  'bit)) 
(defvar  *edge-li3t*)  ; 
(defvar  *vertex-list * )    ; 


*  A  A  *  * 


*  *  *  *  * 


Attribute  3  is  coords  of  opt-path-list  parent 
Bit-valued  array  to  mark  region  boundaries. 
The  (X,Y,0)  element  specifies  whetlier  ttiere  is 
a  boundary  to  immediate  right  of  cell  (X,Y) . 
The  (X,Y,1)  element  specifies  whether  there  is 
a  boundary  immediately  below  cell  (X,Y) . 
Altho  this  array  has  enough  info  to  specify 
boundaries  between  pixels,  pixel  (X,Y)  is 
plotted  as  the  boundary. 

These  lists  are  for  the  heuristic  version,  and 
list  all  edge  cells  witli  edge  id  S  vertex  cells, 
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...     _*_  Mode:  LISP;  Syntax:  Common-Lisp;  Package:  USER  -*- 
I 

r 

;*****  "initmap"  contains  the  functions  used  by  "opm"  to  examine 

;*****  the  map  symbols  and  encode  them  into  elements  of  the 

.AAAAA  A^gjj*  array.   It  is  loaded  by  function  "opm"  in  file  "opm". 

;*****  This  version  is  for  use  with  maps  in  the  form  of  a  rectangle 

.AAAAA  q£  characters. 

.AAAAA 
t 

.AAAAA  Current  as  of  8  Jun  89 

•  AAAAA 

I 

.AAAAA  Input:  file  "map",  an  array  of  cell  attributes 

•  AAAAA 

f 

.AAAAA  Side  Effects:  Loads  file  "map. lisp",  and  sets  the 
.AAAAA         elements  of  the  *cell*  array  according  to  the 
•AAAAA         associated  map  symbol.  Adjusts  *map-width* . 

.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 


.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

•AAAAA  Function  "initialize-map"  initializes  the  values  of  the 

.AAAAA      array  *cell*  according  to  the  information  encoded 

•  AAAAA      j[^p  graphic  form  in  the  file  "map". 

•AAAAA    Arguments:  none 

•AAAAA    Returned:  t  in  all  cases. 

.AAAAA    Side  Effects:  Loads  the  Lisp  file  "map". 

•AAAAA  Initializes  the  arrays  *cell*  and  *boundary* 

•AAAAA  and  adjusts  the  variable  *map-width* . 

•AAAAA    Functions  Used:  process-line,  process-char 

(defun  initialize-map  () 

(load  "map")  (linefeed)  (linefeed) 
(princ  "Initializing  Map") (linefeed) 
(cond  (  (equalp  *version*  "vertex-edge") 

(process-vertex-info  * vert ex- list  * ) 
(process-edge-info  *edge-list*) ) ) 
(setq  *map-width*  (+  2  (length  (aref  *mapline*  1)))) 
(do  ( (I  0  (1+  I) ) ) 

( (=  *map-width*  I))  ;  Initialize  the  top 

(process-char  #\x  10))  ;  "buffer  zone"  row 

(do(  (J  1  (1+  J)  )  ) 

(  (string-equal  "eof "  (aref  *mapline*  J) ) 
(do  ( (I  0  (1+  I) ) ) 

( (=  *map-width*  I))  ;  Initialize  the  bottom 

(process-char  #\x  I  J) ) )  ;  "buffer  zone"  row 

(cond  (  (>=  J  *map-lengt)i* ) 

(princ  '  IWAPNING:  Map  too  long,  will  be  truncatedl)  (linefeed) 
(process-line  (aref  *mapline*  *map-length* )  1  *map-lengt h* ) ) 
(t 

(princ  "    Processing  Map  Row  ")  (prinl  J)  (linefeed) 
(process-line  (aref  *mapline*  J)  1  J) ) ) ) 
(princ  "Finished  Initializing  Map")  (linefeed)  (linefeed)) 


•  AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

;*****  Function  "process-line"  cycles  tliru  each  character  of  the 


AAAAA 
AAAAA 
AAAAA 
A  *  *  *  * 


argument  (a  string)  up  to  the  max  allowed  width  of  the  map. 
It  processes  each  character  and  sends  a  warning 
message  to  tlie  screen  if  line  is  too  long. 
Arguments:  Line,  a  string 


*****    Returned:  t  in  all  capes. 


A  *  *  ft  * 


Side  Effects:  Sets  a  1-pixel  border  in  right  fi  left  columns 
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;*****      represented  as  an  obstacle. 
.*«***    Functions  Used:  process-char 
(defun  process-line  (Line  X  Y) 

(cond  (  (=  0  (length  Line) )  ;  Normal  base  case 

(process-char  #\x  0  Y)  ;  Initialize  the  right  and  left 

(process-char  #\x  X  Y))  ;  "buffer  zone"  columns 

(t  (process-char  (character  (subseq  Line  0  1))  X  Y) 
(setq  X  (1+  X) ) 

(cond  (  (>=  X  *inap-widt  h* )  ;  Abnormal  case  if  map  is  too  wide 

(process-char  #\x  0  Y)       ;  Initialize  the  right  and  left 
(process-char  #\x  (1-  X)  Y)  ;  "buffer  zone"  columns 
(princ  '  I  WARNING:  Map  too  wide,  will  be  truncatedl)  (linefeed)) 
(t  (process-line  (subseq  Line  1)  X  Y)))))) 

.AAAAA  function  "pr ocess-char "  decodes  each  character  of  the  map, 
.AAAAA      setting  the  cost  element  and  in  some  cases  the  parent 
.AAAAA      (jf  (^f^g  cell  indexed  by  X  and  Y,  the  cell's  coords, 
;*****      and  the  parent  of  the  cell  on  the  Optimal-Path-List 
.AAAAA    Arguments:  Char,  a  character,  and  X  &  Y,  integers. 
.AAAAA    Returned:  not  applicable. 

.AAAAA    Side  Effects:  Sets  the  values  of  the  (X, Y, 0)  element  of  the 
.AAAAA      *cell*  array  to  the  cost  as  specified  by  the  character; 
;*****      in  some  cases  sets  the  values  of  the  (X,Y,1)  and  (X,Y,3) 
.AAAAA      elements  for  cells  having  no  parent. 
.AAAAA    Functions  Used:  no  user-defined  functions, 
(defun  process-char  (Char  X  Y 
Saux  X-  X+  Y-  Y+) 

(setq  X-  (-  X  (/  1  *magni f ication*) ) ) 
(setq  Xf  (^  X  (/  1  *magnif ication*) ) ) 
(setq  Y-  (-  Y  (/I  'magnification*))) 
(setq  Y+  (+  Y  (/  1  *magnif ication*) ) ) 

(cond  ((and  (>=  (char-int  Char)  49)   (<=  (char-int  Char)  57)) 
(setf  (aref  *cell*  X  Y  0)   (-  (char-int  Char)  48)) 
(setf  (aref  *cell*  X  Y  1)  nil) 

(setf  (aref  *cell*  X  Y  2)   (cons  Char  (aref  *cell*  X  Y  2))) 
(setf  (aref  *cell*  X  Y  3)  nil) 
(cond  (  (=  1  (aref  *cell*  X  Y  0) )  nil) 
(t  (setq  'terrain-pixel-list* 
(append 

(mapcar  ' magnif y-pixel 
(list 

(list  X  Y) )) 
*ter rain-pixel-list  * )  )  )  )  ) 
(  (equal  Char  #\  ) 

(setf  (aref  *cell*  X  Y  0)  nil) 
(setf  (aref  *cell*  X  Y  1)   (list  X  Y)) 

(setf  (aref  *cell*  X  Y  2)   (cons  Char  (aref  *cell*  X  Y  2))) 
(setf  (aref  *cell*  X  Y  3)   (list  X  Y)  )  ) 
(  (equal  Char  #\x) 

(setf  (aref  *cell*  X  Y  0)  nil) 
(setf  (aref  *cell*  X  Y  1)   (list  X  Y)) 

(setf  (aref  'cell*  X  Y  2)  (cons  Char  (aref  'cell*  X  Y  2))) 
(setf  (aref  *cell*  X  Y  3)  (list  X  Y) ) 
(setq  X-  (-  X  (/  1  *magriif ication*)  )  ) 
(setq  X+  (+  X  (/  1  *magnif ication*) ) ) 
(setq  Y-  (-  Y  (/I  'magnification*))) 
(setq  Y-l  (4  Y  (/  1  *magnification*)  )  ) 
(setq  * ter rain-pixel-list  * 
(append 

(mapcar  ' magni f y-pixel 
(list  (list  X-  Y-) 
(list  X-  Y) 
(list  X-  Y+) 
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(list  X  y-) 

(list  X  Y) 
(list  X  Y+) 
(list  X+  Y-) 
(list  X+  Y) 
(list  X+  Y+) ) ) 
*terraiii-pixel-list  *  )  )  ) 
(  (equal  Char  #\r) 

(setf  (aref  *cell* 
(setf  (aref  *cell* 
(setf  (aref  *cell* 
(setf  (aref  *cell* 
(setq  X+  (+  X  (/I 
(setq  Y-  (-  Y  (/I 
(setq  Y+  (+  Y  (/  1 
(setq  *  terrain-pixel-list 
(append 
(mapcar 
(list 


*river-co3t 

nil) 

(cons  Char 

nil) 
*niagni  f  ication*  )  )  ) 
*inagni  f  icat  ion*  )  )  ) 
♦magnification*)  )  ) 


X  Y 

0) 

X  Y 

1) 

X  Y 

2) 

X  Y 

3) 

(aref  *cell*  X  Y  2) ) ) 


' magni  fy-pixel 
(list  X+  y-) 
(list  XH  Y) 
(list  X+  Y+) ) ) 
*ter rain-pixel-list  * ) ) ) 
( (equal  Char  #\p) 

(setf  (aref  *ceJl* 
(aref  *cel ] * 
(aref  *cel 1  * 
(aref  *cell* 


(setf 
(setf 
(setf 
(setq 


X 

Y 

0) 

*  road-cost  * ) 

X 

Y 

1) 

nil) 

X 

Y 

2) 

(cons  Char  (aref 

*cell* 

X 

X 

Y 

3) 

nil) 

Y  2))) 


*terrain-pixel-list* 
(cons  (list  X  Y)  *ter rain-pixel-list *)) ) 
(  (equal  Char  #\G) 

X  Y)  ) 

X  Y  0) 

X  Y  1) 

X  Y  2) 

X  Y  3) 


(setq  *goal*  (list 

(setf  (aref  *cell* 

(setf  (aref  *cell* 

(setf  (aref  *cell* 

(setf  (aref  *cell* 


1) 

(list  X  Y) ) 

(cons  Char  (aref  *cell*  X  Y  2) ) ) 

(list  X  Y) ) ) )  ) 


*****   Function  "process-vertex-info"  puts  the  character  v  into  each 
*****     *cell*  X  Y  2  as  a  list  (#\v) .  This  becomes  the  third  element  of 
*****     this  list  after  "process-edge-info"  and  "process-char"  happen, 
(defun  procegs-vertex-inf o  (v-list) 

(setf  (aref  *cell*  (caar  v-list)   (cadar  v-list)  2) 

(list  #\v)) 
(cond  ((null  (cdr  v-list))) 

(t  (process-vertex-info  (cdr  v-list))))) 


****** 

***** 

***** 

***** 

***** 

***** 

***** 

***** 

(de  fun 
(let 


******************************************************************* 

Function  "process-edge-info"  puts  the  id  number  of  the  appropriate 
edge  into  *cell*  X  Y  2  as  the  first  element  of  the  list  there. 
This  becomes  the  second  element  of  the  list  after  "process-char" 
is  executed. 

"e-list"  is  a  list  of  triples:  e.g., 

((X  Y  13)   (U  V  21)   ...   (Z  W  2)),  where  for  example,  13  is  the 
id  number  of  the  edge  on  which  cell  (X  Y)  is  located, 
process-edge- j nfo  (e-list) 
( (X  (first  (first  e-list))) 
(Y  (second  (first  e-list))) 
(EdgelD  (third  (first  e-list)))) 
(cond  ( (characterp  ;  If  cell  is  a  vertex,  and 

(first  (aref  *cell*  X  Y  2)))   ;  no  other  edge  id  has  been 
(setf  (aref  *cell*  X  Y  2)        ;  set  for  this  cell,  set  1st 
(cons  (list  EdgelD)       ;  element  of  list  to  EdgelD, 
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(aref  *cell*  X  Y  2) ) ) ) 
((null  (first  (aref  *cell*  X  Y  2)))  ;  If  cell  is  not  a  vtx,  and  no 
(setf  (aref  *cell*  X  Y  2)  ;  other  edge  id  has  been  set, 

(list  (list  EdgelD) ) ) )      ;  set  EdgelD 
(  (listp  (first  (aref  *cell*  X  Y  2)))      ;  If  another  edge  id  has 
(setf  (aref  *cell*  X  Y  2)  ;  been  set  for  tliis  cell, 

(COM3  (cons  Edgf»ID  ;  cons  EdgelD  onto  the 

(first  (aref  *cell*  X  Y  2)))      ;  1st  element  of  the 
(rest  (aref  *cell*  X  Y  2))))))  ;  previous  list, 
(cond  ((null  (rest  e-list))) 

(t  (process-edge-info  (rest  e-list)))))) 
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; ;  -*-  Mode:  LISP;  Syntax:  Common-Lisp;  Package:  USER  -*- 

******************************************************************** 

**«*********A*****A***********A*******A***************************** 

*****  File  "bdry"  contains  the  functions  which  detect  and  record 
*****  boundaries  between  terrain  cells.  It  also  sets  and  checks 
*****  equivalence  between  optimal-path  lists. 

A  A  A  A  A 

*****  Current  as  of  27  Jun  89 

A  A  A  A  * 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

;*****  Function  "check-all-boundaries"  iterates  through  the  whole  map 

.AAAAA    ^f-j    find  boundaries.  It  is  used  when  boundary-checking  is  done 

;*****    after  completion  of  wavefront  expansion. 

.AAAAA    Arguments:  None 

.AAAAA    Returned:  not  applicable 

<defun  check-all-boundaries  () 

(setf  *boundary-pixel-list *  nil) (linefeed) 
(cond 
((equal  "pure"  *version*) 
(do  (  (J  1  (1+  J)  )  ) 

((string-equal  "eof"  (aref  *mapline*  J)) 

(linefeed)  (princ  "Finished  With  Boundary  Detection")  (linefeed)  (linefeed)) 
(princ  "Pure  Bdry  Detection  for  Row  ")   (prinl  J) (linefeed) 
(do  ( (I  1  (1+  I) )  ) 

( (>=  I  ♦map-width*) ) 

(cond  ((null  (aref  *cell*  (1+  I)  J  1)))   ;  Check  (I, J)  against 
( (pure-bdry-condit ion  ;   (I+1,J) 

I  J  (1+  I)  J) 
(add-to-bdry  I  J  (1+  I)  J))) 
(cond  ((null  (aref  *.:ell*  I  (1+  J)  1)))   ;  Check  (I,  J)  against 
( (pure-bdry-condit ion  ;   (I,J+1) 

I  J  I  (1+  J)  ) 
(add-to-bdry  I  J  I  (1+  J)))) 
(cond  ((null  (aref  *cell*  (1^  I)   (1>  J)  1)))  ;  Check  (I, J)  against 
( (pure-bdry-condit ion  ;   (I+1,J+1) 

I    J     (1+    1)      (1+    J) ) 
(add-to-bdry    I    J     (1+    I)      (1+    J))))))) 
((equal     "diverging-patli"    *version*) 
(do     ((J    1     (1+    J) ) ) 

( (string-equal  "eof"  (aref  *mapline*  J) ) 

(linefeed)  (princ  "Finished  With  Boundary  Detection")  (linefeed)  (linefeed)) 
(princ  "Diverging-Patli  Bdry  Detection  for  Row  ")   (prinl  J) (linefeed) 
(do  (  (I  1  (1+  I)  )') 

( (>=  I  *map-width*) ) 

(cond  ((null  (aref  *cell*  {l^    I)  J  1)))   ;  Check  (I, J)  against 
( (diverging-path-bdry-condition  ;   (I+1,J) 

I  J  (1+  I)  J) 
(add-to-bdry  I  J  (1+  I)  J))) 
(cond  ((null  (aref  *cell*  1  (ll  ^i)  1)))   ;  Check  (1,0)  against 
((diverging-path-bdry-condition  ;   (I,Jfl) 

I  J  1  ( 1  +  J )  ) 
(add-to-bdry  1  J  I  (1-t  .1)))) 
(cond  ((null  (aref  *cell*  (1+  I)   (14  J)     1)))  ;  Check  (I,  J)  against 
((diverging-path-bdry-condition  ;   ( I  I  1  ,  .1  I  1  ) 

I  J  (1+  I)   (1+  J)) 
(add-to-bdry  I  J  ( 1+  I )   (1+  J))))))) 
((equal  "vertex-edge"  *version*) 
(do  (  (J  1  (14  J)  )  ) 

( (st r ing-equa]  "eof"  (aref  *mapline*  J)) 
(linefeed) (princ  "Finished  With  Boundary  Detection") (linefeed) (linefeed)) 
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(princ  "Vertex-Edge  Bdry  Detection  for  Row  ")   (prinl  J) (linefeed) 
(do  < (1  1  (1+  I) ) ) 

(  (>-  I  *niap-width*)  ) 

(cond  ((null  (aref  *cell*  (1+  I)  J  1)))   ;  Check  (I, J)  against 
( ( vertex-edge-bdry-condit ion        ;   (I+1,J) 

I  J  (1+  I)  J  0  (list  I  J  (1+  I)  J)) 
(add-to-bdry  I  J  (1+  I)  J))) 
(cond  ((null  (aref  *cell*  I  (1+  J)  1)))   ;  Check  (I, J)  against 
( (ver tex-edge-bdry-condit ion        ;  (I,J+1) 
I  J  I  (1+  J)  0  (list  I  a  I  (1+  J))) 
(add-to-bdry  I  J  I  (1+  J)))) 
(cond  ((null  (aref  *cell*  (II  I)  (1+  J)  1)))  ;  Check  (I, J)  aga 
( ( vertex-edge-bdry-condit ion  ;  (I+1,J+1) 

I  J  (1+  I)   (1+  J)  0  (list  I  J  (1+  I)   (1+  J))) 
(add-to-bdry  I  J  (1+  I)  ( 1+  J) ))))))) ) 


*  *  * 

*  *  *  A  * 

*  *  *  •  * 


*****  Function  "check-f or-boundar ies "  checks  each  of  a  cell's  four  orthogonal 
*****  neighbors  for  the  existence  of  a  region  boundary.  It  is  used 

*****    when  boundary-checking  is  done  incrementally  during  wave  expansion. 
*****    Arguments:  Center-cell, a  list  of  the  coords  of  the  cell  being 
*****  checked  and  aux  (local)  variables  to  hold  the  coords 

*****  Returned:  not  applicable 

*****    Side  Effects:  if  bdry  exists,  the  appropriate  pixels  are  added 
""""      to  *boundary-pixel-list *  and  *boundary-bit *  (X, Y)  is  set. 
Functions  Used:  check-neighbor 

(defun  check-f or-boundar ies  (Center-cell 
Saux  X  Y) 
(setq  X  (car  Center-cell)) 
(setg  Y  (cadr  Center-cell) ) 
(cond 
((equal  "vertex-edge"  'version*) 

(cond  ((null  (aref  *cell*  X  (1-  Y)  1)))    ;  Check  (X,Y)  against  (X,Y-1) 

;  If  (X,Y-l)'s  parent  is  undefined 
;  boundary  cannot  be  cliecked  yet, 
( ( vertex-edqe-bdry-condi t ion      ;  Else  it  can  so  call  bdry  condition. 
X  Y  X  (1-  Y)  0  (list  X  Y  X  (1-  Y))) 
(add-to-bdry  X  Y  X  (1-  Y) ) ) )  ;  If  bdry-cond  =  T,  add  to  bdry-list 

(cond  ((null  (aref  *cell*  (1-  X)  Y  1))) 

(  (vertex-edge-bdry-condit ion      ;  Check  (X, Y)  against  (X-1,Y) 
X  Y  (1-  X)  Y  0  (list  X  Y  (1-  X)  Y) ) 
(add-to-bdry  X  Y  (1-  X)  Y) ) ) 
(cond  ((null  (aref  *cell*  X  (1+  Y)  1))) 

( ( vertex-edge-bdry-condition      ;  Check  (X,Y)  against  (X,Y+1) 
X  Y  X  (1+  Y)  0  (list  X  Y  X  (1+  Y) ) ) 
(add-to-bdry  X  Y  X  (1+  Y) ) ) ) 
(cond  ((null  (aref  *cell*  (1+  X)  Y  1))) 

((vertex-edge-bdry-condition      ;  Check  (X,Y)  against  (X+1,Y) 
X  Y  (1+  X)  Y  0  (list  X  Y  (H  X)  Y)) 
(add-to-bdry  X  Y  (1+  X)  Y) ) ) ) 
((equal  "pure"  *version*) 

(cond  ((null  (aref  *cell*  X  (1-  Y)  1)))     ;  Check  (X,Y)  against  (X,Y-1) 

;  If  (X,Y-l)'s  parent  is  undefined 
;  boundary  cannot  be  checked  yet, 
( (pure-bdry-condi t ion  ;  Else  it  can  so  call  bdry  condition. 

X  Y  X  (1-  Y) ) 
(add-to-bdry  X  Y  X  (]-  Y))))  ;  If  bdry-cond  =  T,  add  to  bdry-list 

(cond  ((null  (aref  *cell*  (1-  X)  Y  1))) 

(  (pur<=-bdry-condi  t  ion  ;  Check  (X,Y)  against  (X-1,Y) 

X  Y  (1-  X)  Y) 
(add-to-bdry  X  Y  (1-  X)  Y))) 
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(cond 


(cond 


(  (equal 

(cond 


(cond 


(cond 


(cond 


(null  (aref  *cell*  X  (1+  Y)  1))) 

(pure-bdry-condition  ;  Check  (X,Y)  against  (X,Y+1) 

X  Y  X  (1+  Y)  ) 
(add-to-bdry  X  Y  X  (1+  Y)))) 
(null  (aref  *cell*  (1+  X)  Y  1))) 
(pure-bdry-condition  ;  Check  (X,Y)  against  (X+1,Y) 

X  Y  (1+  X)  Y) 
(add-to-bdry  X  Y  (1+  X)  Y) ) ) ) 
diverging-path"  *ver3ion*) 
(null  (aref  *cell*  X  (1-  Y)  1))) 


( di ve r gi ng - pa th-bdry- condition 

X  Y  X  (1-  Y) ) 
(add-to-bdry  X  Y  X  (1-  Y)))) 
(null  (aref  *cell*  (1-  X)  Y  1))) 
(diverging-path-bdry-condition 

X  Y  (1-  X)  Y) 
(add-to-bdry  X  Y  (1-  X)  Y) ) ) 
(null  (aref  *cell*  X  (1+  Y)  1))) 
(diverging-path-bdry-condition 

X  Y  X  (1+  Y) ) 
(add-to-bdry  X  Y  X  (1+  Y)))) 
(null  (aref  *cell*  (1+  X)  Y  1))) 
(diverging-path-bdry-condition 

X  Y  (1+  X)  Y) 
(add-to-bdry  X  Y  (1+  X)  Y) ) ) ) ) ) 


;  Check  (X,Y)  against  (X,Y-1) 

;  If  (X,Y-l)'s  parent  is  undefined 

;  boundary  cannot  be  checked  yet, 

;  Else  it  can  so  call  bdry  condition. 

;  If  bdry-cond  =  T,  add  to  bdry-list. 

;  Check  (X,Y)  against  (X-1,Y) 


;  Check  (X, Y)  against  (X,Y+1) 


;  Check  (X,Y)  against  (X+1,Y) 


A  A  *  A  A 


A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  *  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  *  A  A 

A  A  A  *  A 

*  A  A  A  A 

A  A  A  A  A 


Function  " vertex-edge-bdry-condit ion"  checks  if  there  is  a  boundary 
between  two  cells  by  seeing  if  their  OPL' s  have  equivalent  "critical" 
points,  where  a  critical  point  is  a  turn-cell  which  is  on  an  edge 
or  is  adjacent  to  a  terrain-feature  vertex. 

Arguments:  Coords  of  2  cells  which  may  be  in  different  regions; 
Flag  which  is  0  normally,  but  for  double-edged  cells  on  the 
second  recursive  call  witli  that  cell  is  a  list  of  the  left-over  edge-id, 
and  for  edge-interior  pairs  is  1  or  (edge-id)  after  initial  call. 
Returned:  nil  if  condition  does  not  hold,  and  T 

if  condition  does  hold. 
Side  Effects:  none 


(defun  vertex-edqe-bdry-condition  (XI  Yl  X2  Y2  Flag  StartPoints) 

(let*  (  (Xsl  (first  StartPoints))  ;  bdry  cond  based  on  vertex 

(Ysl  (second  StartPoints))  ;  and  edge  turn  points. 

(Xs2  (third  StartPoints) ) 
(Ys2  (fourth  StartPoints)) 

(Parentl  (  f ir st-dist inguished-opl-cell  XI  Yl  Xsl  Ysl)) 
(Parent2  (f irst-distinguished-opl-cell  X2  Y2  Xs2  Ys2)) 
(Xpl  (first  Parentl)  ) 
(Ypl  (second  Parentl)) 
(Xp2  (first  Farent2) ) 
(Yp2  (second  Parent2) ) ) 
(cond 

((not  (equal  ;  Case 

(first  (aref  *cell*  Xsl  Ysl  2)) 
(first  (aref  *cell*  Xs2  Ys2  2)))) 
't) 
( (and  ;  Case  Bl : 

(<  1  (length  (aref  *cell*  Xsl  Ysl  2))) 
(equal 


(second  (aref  *cell*  Xsl  Ysl  2)) 
(third  Farent2) ) 


If  the  start-pts  themselves  have 
different  costs,  they  are  in  different 
regions.  This  condition  fires  only 
on  the  1st  call  to  v-e-b-c. 
If  SPl  is  edge  (&  SP2  is  inside  same 
rgn,  by  A  above)  and  Parent  of  2 
is  on  the  same  edge  as  SPl,  and 
SPl  is  not  tlie  1st  of  a  pair  of 
double-edge  cells,  do  not  put  a 


OTl 


(not  (equal 

(second  (aref  *cell*  Xsl  Ysl  2)) 
(third  Parentl) ) ) ) 
nil) 
((and  ;  Case  B2:  If  SP2  is  edge  (&  SPl  is  inside  same 


bdry  between  SPl  S  SP2. 
(Tliis  case  makes  edge  cells  & 
interior  cells  be  in  same  rgn.) 


Case  C: 
;  Ptl 


(<  1  (length  (aref  *cell*  Xs2  Ys2  2))) 
(equal 

(second  (aref  *cell*  Xs2  Ys2  2)) 
(third  Parentl) ) 
(not  (equal 

(second  (aref  *cell*  Xs2  Ys2  2)) 
(third  Parent2) ) ) ) 
nil) 
( (and  (=  Xpl  Xp2) 

(=  Ypl  Yp2))  nil) 
((and  (=  3  (length  Parentl)) 

(=  3  (length  Parent2) ) )  ; 
(cond 

((set-equal  (third  Parentl) 
(tl)ird  Parent2)  ) 
(vert ex-edge -bdry- cond it  ion 

Xpl  Ypl  Xp2  Yp2  0  StartPoints) ) 
( (and  ;  Case  D2: 

(subsetp  (third  Farent2) 

(third  Parentl) ) 
(not  (listp  Flag) ) ) 
( vert ex -edge -bdry-condit ion 
XI  Yl  Xp2  Yp2 
(set -di  f f erence 
(third  Parentl) 
(third  Pareiit2)  ) 
StartPoints) ) 
(  (and 

(subsetp  (third  Parentl) 

(third  Parent2) ) 
(not  (listp  Flag) ) ) 
( vert ex-edge-bdry-condit ion 
Xpl  Ypl  X2  Y2 
(set-difference 
(third  Parent2) 
(third  Parentl) ) 
StartPoints) ) 
(  (and 

(subsetp  (third  Parent2) 

(third  Parentl) ) 
(equal  Flag 

(third  Parent2) ) ) 
(vert ex-edge -bdry-condit ion 

Xpl  Ypl  Xp2  Yp2  0  StartPoints) ) 


rgn,  by  A  above)  and  Parent  of  1 
is  on  the  same  edge  as  SP2,  and 
SP2  is  not  the  Ist  of  a  pair  of 
double-edge  cells,  do  not  put  a 
bdry  between  SPl  S  SF2. 
(This  case  makes  edge  cells  S 
interior  cells  be  in  same  rgn.) 


If  Parentl  S  Parent2  are  the  same, 
&  Pt2  are  in  same  region. 


Case  D:  If  parents  are  both  edge  cells: 

;  Case  Dl:     If  edge-id  lists  are  the  same, 
;  clik  next  pair  of  cells  on  OPL  recursively 
;   (Normal  case) 


Else  if  Parentl  is  a  double-edge  cell  and 
one  of  its  edge-ids  —  edge-id  of  Parent2, 
and  this  is  the  1st  time  Parentl  has  been 
checked  in  this  set  of  calls  to  v-e-b-c 
recursively  check  OPL  witli  Pointl  and 
Parent2,  with  flag  :=  (uiunatched-edge-id) 
of  Parentl.  (Only  applies  where  cell  1  is 
is  on  two  edges.) 

Case  D3; 

Else  if  Parent2  is  a  double-edge  cell  and 
one  of  its  edge-ids  —  edge-id  of  Parentl, 
and  this  is  the  1st  time  Parent2  has  been 
checked  in  this  set  of  calls  to 
v-e-bdry-cond,  recursively  check  OPL  with 
Parentl  and  Point2,  witli  flag  :  = 
(unmatched-edge-id)  of  Parent2. 


Case  D2,  Second  Pass: 

Else  if  Parentl  is  a  double-edge  cell  and 
its  previously  unmatched  edge-id  =  id  of 
Parent2,  recursively  check  OPL  from 
Parentl  &  Parent2,  with  Flag  =  NIL. 


Case  D3,  Second  Pass: 

;  Else  if  Farent2  is  a  double-edge  cell  and 

;  and  previously  unmatched  edge-id  =■  id  of 

;  Parentl,  recursively  check  OPL  from 

;  Parentl  and  Parent2,  with  Flag  -  NIL. 


(  (and 

(subsetp  (third  Parentl) 

(third  Parent2) ) 
(equal  Flag 

(third  Parentl) ) ) 
(vert  ex -edge -bdry-condit  ion 

Xpl  Ypl  Xp2  Yp2  0  StartPoints)) 
(t  't)))  ;  Case  D4 :  Otherwise  pts  are  in  different  rgns 

(t  't))))  ;  Case  E:  OTHERWISE  pts  are  in  different  rgns. 


*****    Function  " f ir st-dist inguished-opl-cell "  finds  the  first  cell  on 
*****    j^f^g  Qp]^  Qf  p(-  x^Y  which  is  a  "distinguished"  point.  It  is  called 
*  *  *  *  * 


*************** 

Function  "first- 


by  function  "heur istic-bdry-condit ion' 
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*****    Arguments:  coords  of  the  cell  whose  opl  is  being  checked 
*****    Returned:  a  list  of  the  coordinates  of  the  distinguished  cell. 


***** 
***** 


followed  if  it  is  an  edge  cell  by  the  edge  id 
Side  effects:  none 
(defun  f irst-distinguished-opl-cell  (X  Y  Xs  Ys 
&aux  DcelJ ) 
(cond  (  (equalp 

(list  X  Y) 

(aref  *cell*  X  Y  3))  (list  X  Y)  ) 
((setf  Dcell  (distinguished-cell 
(first  (aref  *cell*  X  Y  3)) 
/  (second  (aref  *cell*  X  Y  3)))) 

(cond 

( (=  3  (length  Dcell))  Dcell) 
( (not  (equal 

(first  (aref  *cell*  Xs  Ys  2)) 
(first  (aref  *cell* 

(first  Dcell) 
(second  Dcell) 
2)  )  )  ) 
Dcell) 
(t  (f irst-dist inguished-opl-cell 
(first  (aref  *cell*  X  Y  3)) 
(second  (aref  *cell*  X  Y  3) ) 
Xs  Ys) ) ) ) 
(t  ( first -distinguished-opl-cell 
(first  (aref  *cell*  X  Y  3) ) 
(second  (aref  *cell*  X  Y  3)) 
Xs  Ys) ) ) ) 


num. 


If  opl-parent^point ,  cell  is  obstacle 
or  goal,  so  return  the  point  itself, 
(base  case  2) 

If  opl-parent  is  distinguished,  rtn 
coords  of  parent  and  possibly  tlie 
edge  id  number,  (base  case  3) 

If  Dcell  is  edge  cell,  rtn  Dcell. 
If  Dcell  is  vertex  and  this  path 
started  outside  the  terrain  feature 
of  which  Dcell  is  a  vtx,  rtn  Dcell. 


Else,  recurse  to  look 
at  next  cell  on  opl. 


Else,  recurse  to  look 
at  next  cell  on  opl. 


********** 

*  *  *  *  * 

*  *  *  *  * 


*  *  *  *  * 

A  *  *  *  * 

*  *  *  *  * 

*  A  *  *  A 

*  *  *  A  * 


********AAAAAAAAA***************A****A*******AA**AA****** 

Function  "distinguished-cell"  determines  whether  cell  is  an  edge 
or  adjacent  to  a  terrain-feature  vertex. 
Arguments:  coords  of  tlie  cell  being  cliecked  for  distlng.  status 
Returned:   (X  Y  edge-id-list)  if  cell  is  on  an  edge 
(X  Y)  if  cell  is  adjacent  to  a  vertex 
nil  if  cell  is  not  distinguished 
Side  effects:  none 


X  Y  2))  ) 


(defun  distinguished-cell  (X  Y) 
(let  ( (X-  (i-  X) ) 
(X+  (1+  X) ) 

(Y-  (1-  Y)) 
(Y+  (1+  Y) ) ) 
(cond 

((and  (<  1  (length  (aref  *cell* 
(equa J 

(second  (aref  *cell*  X  Y  2)) 
(second 

(aref  'cell* 

(first  (aref  *cell*  X  Y  1)) 
(second  (aref  *cell*  X  Y  1)) 
2) ) ) )  nil) 
( (<  1  (length  (aref  *cell*  X  Y  2))) 

(list  X  Y  (second  (aref  *cel]*  X  Y  2)))) 
((and  (=  3  (length  (aref  *cell*  X-  Y  2))) 

(not  (equalp  (first  (aref  *cell*  X  Y  2)) 

(first  (aref  *cell*  X-  Y  2))))) 
(list  X-  Y) ) 
((and  (=  3  (length  (aref  *cell*  X-  Y+  2))) 

(not  (equalp  (first  (aref  *cell*  X  Y  2)) 

(first  (aref  *cell*  X-  Y+  2)))) 
(list  X-  Y+) ) 
((and  (=  3  (length  (aref  *cell* 


If  (X,Y)  is  edge  cell 

and  is  the  first  of  a 

pair  of  adjacent  cells 

of  the  same  edge  in  the 
same  backpath, 
return  nil . 


If  (X,Y)  is  a  single  edge  cell, 
return  coords  &  edge-id-list. 


Else  if  (X,Y)  is 
adjacent  to  a  vertex 
and  is  outside  the 
terrain  feature  of 
which  the  vertex  is 
a  part,  return  coords 
of  vertex. 


X  Y- 


2) 


(not  (equalp  (first  (aref  *cell*  X  Y  2)) 


22.-^ 


(list  X  Y-) ) 
((and  (=  3  (length 
(not  (equalp 

(list  X-  Y-) ) 
( (and  (=  3  (length 
(not  (equalp 

(list  X  Y+) ) 
( (and  (=  3  (length 
(not  (equalp 

(list  X+  Y-) ) 
(  (and  (=  3  (length 
(not  (equalp 

(list  X+  Y) ) 
( (and  (-  3  (length 
(not  (equalp 

(list  X+  Y4) ) 
(t  nil) ) ) ) 


(first  (aref  *cell*  X  Y-  2))))) 

aref  *cell*  X-  Y-  2) ) ) 
first  (aref  *cell*  X  Y  2)) 
first  (aref  *cell*  X-  Y-  2))))) 

aref  *cell*  X  Y+  2) ) ) 
first  (aref  *cell*  X  Y  2)) 
first  (aref  *cell*  X  Y+  2))))) 

aref  *cell*  X+  Y-  2) ) ) 
first  (aref  *ce]l*  X  Y  2)) 
first  (aref  *cell*  X+  Y-  2))))) 

aref  *cell*  X+  Y  2) ) ) 
first  (aref  *cell*  X  Y  2)) 
first  (aref  *cell*  X+  Y  2))))) 

aref  *cell*  X+  Y+  2) ) ) 
first  (aref  *cell*  X  Y  2)) 
first  (aref  *cell*  X+  Y+  2))))) 


Else  (X,Y)  is  not  adjacent  to  a  vertex 
and  is  not  an  edge  cell 


*****  Function  "add-to-bdry "  sets  the  boundary  bit  to  1  and 

*  *  *  *  * 

A  A  A  *  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  *  A 


adds  boundary  pixels  to  the  front  of  the  boundary  list 

unless  one  of  the  arguments  is  an  obstacle  cell. 

Argument :  coords  of  two  points  whose  boundary 
is  to  be  added. 

Returned:  always  returns  T 

Side  effects:  Sets  *boundary*  bit  to  1  and 
sets  *boundary-pixel-list *  to  the  previous 
list  with  the  new  pixels  appended  to  the  front. 


(defun  add-to-bdry  (XI  Yl  X2  Y2 
fiaux  Xa  Xb  Ya  Yb) 
(cond 

((or  (char-equal  #\x  (car  (aref  *cell*  XI  Yl  2))) 

(char-equal  #\x  (car  (aref  *cell*  X2  Y2  2))))'t) 
(t 

(-  X2  XI)  *magnif ication*) ) ) 
(-  Y2  Yl)  *magnif ication*) ) ) 


(/ 
(/ 


X2  XI) 
Y2  Yl) 


(-  Yl  Y2) )  0) 


(setq  Xa  (+  XI 

(setq  Ya  (+  Yl 

(setq  Xb  (+  XI   (*  2  (/  (- 

(setq  Yb  (+  Yl  (*  2  (/  (- 

(setf  (bit  *boundary* 

(min  XI  X2) 
(min  Yl  Y2) 
(cond  ( (=  0 

(t  1)  )  ) 
1) 
(setf  *boundary-pixel-list * 
(append 

(mapcar  ' maqnif y-pixel 
(cond 

(  (=  XI  X2) 
(list  (list  (-  XI 
(list 

(list  (+  XI  (/ 
(list  (-  XI  (/ 
(list 


*magnif ication* )  )  )  ) 
*magnif ication*  )  )  )  ) 


Set  the  boundary 
flag  bit  of  the  upper 
or  leftmost  cell. 


(/  1  *magnif icat ion* ) )  Ya) 

XI  Ya) 

1  *maqni f icat ion* ) )  Ya) 

1  *niagnif  ication*  )  )  Yb) 

XI  Yb) 
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(list  (+  XI  (/  1  *magnif ication*) )  Yb) ) ) 
( (=  Yl  Y2) 
(list  (list  Xa  (-  Yl  (/  1  *magnif ication*) ) ) 

Yl  ) 

*niagnif  ication*  )  )  ) 

*magnif ication*  )  )  ) 

Yl  ) 

*magnif ication* ) ) ) ) ) 


(list  Xa 

(list  Xa  (+  Yl 

(/  1 

(list  Xb  (-  Yl 

(/  1 

(list  Xb 

(list  Xb  (4  Yl 

(/  1 

(t 

(list  (list  Xa  Ya) 

(list  Xa  Yb) 

(list  Xb  Ya) 

(list  Xb  Yb) ) ) ) ) 

*boundary-pixel-list * ) )  ' 

t)  )  ) 

********************************************************************* 

,•*****  Function  "set-opl"  sets  the  coords  for  a  cell's  predecessor 

.*****  £fj  (^f^g  optimal-path-list. 

.*****  Arguments:  Xn  and  Yn  the  coords  of  the  new  cell  with  OPL  being 

.*♦***  ggj^  apfj  j(p  ap,(j  Yp  (.^g  coords  of  (Xn,Yn)'s  parent  on  bac)cpath 

.*****  Returned:  not  applicable 

;*****  Side  Effects:  sets  *cell *  (Xn, Yn, 3)  with  n' s  predecessor  on  OPL 

.**«**  Functions  Used:  on-line-between 

(defun  set-opl  (Xn  Yn  Xp  Yp) 

(cond  ( (<  1  (length  (aref  *cell*  Xp  Yp  2)))         ;  If  P  is  an  edge  cell,  set 
(setf  (aref  *cell*  Xn  Yn  3)   (list  Xp  Yp) ) )   ;  pred  of  N  to  P. 
( (on-line-between  Xp  Yp  Xn  Yn  ;  If  P  is  between  N 

(first  (aref  *cell*  Xp  Yp  3))    ;  6  pred  of  P  on  OPL, 
(second  (aref  *cell*  Xp  Yp  3)))  ;  set  pred  of  N  to 
(setf  (aref  *cell*  Xn  Yn  3)   (aref  *cell*  Xp  Yp  3)))       ;  pred  of  P. 
(t  (setf  (aref  *cell*  Xn  Yn  3)   (list  Xp  Yp) ) ) ) )     ;  Else  set  pred  of  N 

;  to  P  itself. 


.AAAAA  Function  "pure-bdry-condit ion" 

.*****  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 

;*****  Returned:  nil  if  condition  does  not  hold,  and  T 

.AAAAA     ^f    condition  does  hold. 

.AAAAA  Side  Effects:  none 

.AAAAA 

(defun  pure-bdry-condition  (XI  Yl  X2  Y2)  ;  "Pure"  boundary  condition: 

(let*  ((Xpl  (car  (aref  *cell*  XI  Yl  3)))     ;  If  OFLs  are  equi valfnt , 

(Ypl  (cadr  (aref  *cell*  XI  Yl  3)))    ;  return  nil,  else  return  T 
(Xp2  (car  (aref  *cell*  X2  Y2  3))) 
(Yp2  (cadr  (aref  *cell*  X2  Y2  3))) 
(Xppl  (car  (aref  *cell*  Xpl  Ypl  3))) 
(Yppl  (cadr  (aref  *cell*  Xpl  Ypl  3))) 

(Xpp2  (car  (aref  *cell*  Xp2  Yp2  3)))         ;  OFLs  are  equivalent  if 
(Ypp2  (cadr  (aref  *cell*  Xp2  Yp2  3))))       ;  first  cells  in  each 
(cond  ( (and  (=  Xpl  Xp2)  ;  OPL  are  equivalent ,  ie, 

(=  Ypl  Yp2) )  nil)  ;  if  they  are  the  same, 

;  or  if  one  is  in  the 
(  (on-1  ine-incl-between  ;  first  leg  of  tlie 

Xpl  Ypl  Xp2  Yp2  Xpp2  Ypp2)  nil)   ;  OPL  of  the  other 
(  (on-line-incl-between 

Xp2  Yp2  Xpl  Ypl  Xppl  Yppl)  nil) 
(  (on-line-incl-between 

Xpl  Ypl  X2  Y2  Xp2  yp2)  nil) 
(  (on-line-incl-between 

Xp2  Yp2  XI  Yl  Xpl  Ypl)  nil) 
(t  (add-to-bdry  XI  Yl  X2  Y2))))) 
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.**********************♦********************************************* 

;*****  runction  "diverging-path-bdry-condition" 

.*****   Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 

.*♦»**   Returned:  nil  if  condition  does  not  hold,  and  T 

.*****     if  condition  does  hold. 

.***»»   Side  Effects:  none 

(defun  diverging-path-bdry-condition  (Xc  Yc  Xn  Yn 

Saux  PC  PXc  PYc  PPc  PFXc  PPYc  PPPC  PPPXc  PPPYc  PN  PXn  PYn  PPn  PPXn  PPYn  PPPN  PPPXn  PPPYn 
(setq  PC  <aref  *cell*  Xc  Yc  1)) 
(setq  PN  (aref  *cell*  Xn  Yn  1)) 

(setq  PXc  (first  PC))  ;  Find  Center-cell's 

(setq  PYc  (second  PC))  ;  parent,  grandparent,  and 

(setf  PPC  (aref  *cell*  PXc  PYc  1) )     ;  great-grandparent 
(setq  PPXc  (first  FFC) ) 
(setq  PPYc  (second  PPC) ) 

(setf  PPPC  (aref  *cell*  PPXc  PPYc  1)) 
(setq  PPPXc  (first  PPPC)) 
(setq  PPPYc  (second  PPPC) ) 

(setq  rxn  (first  FN))  ;  Find  Neighbor-cell's 

(setq  PYn  (second  PH) )  ;  parent,  grandparent,  and 

(setf  PPN  (aref  *cell*  PXn  PYn  1))      ;  great-grandparent 
(setq  PPXn  (first  PPN)) 
(setq  PPYn  (second  FFN) ) 
(setf  PPPN  (aref  *cell*  PPXn  PPYn  1)) 
(setq  PPPXn  (first  PFPN) ) 
(setq  PPPYn  (second  PFFH) ) 

(cond  ((and  (=  Xn  FXn)   (=  Yn  FYn)))  ;  Keeps  obst  from  causing  bdry. 
( (bdry-condit ion-1  ;  If  greatgp' s  are  separated 

PPPXc  PPPYc  PPPXn  PPPYn)      ;  by  more  than  two,  cells  are 
(add-to-bdry  Xc  Yc  Xn  Yn) )      ;  in  different  regions. 
(  (bdry-condit ion-2  ;  If  cell  and  neighbor's 

Xc  Yc  PXn  PYn)  ;  parent  are  in  different 

(add-to-bdry  Xc  Yc  Xn  Yn) )        ;  regions,  so  are  cells. 
( (bdry-condition-2  ;  If  parents  are  in 

PXc  PYc  PXn  PYn)  ;  different  regions, 

(add-to-bdry  Xc  Yc  Xn  Yn) )  ;  so  are  cells. 

(  (bdry-condit ion-3  ;  If  gp' s  are  separated  by  an 

PPXc  PPYc  PPXn  PPYn)         ;  obst  or  river  cell,  there 
(add-to-bdry  Xc  Yc  Xn  Yn) )      ;  is  a  bdry  btwn  cells, 
(t  nil))) 


*  *  *  *  * 

ft  *  *  *  * 

*  *  *  *  * 


Function  "bdry-condit ion-1 " 
Arquinents:  Coords  of  2  cells  which  may  be  in  different  regions 
Returned:  nil  if  condition  does  not  hold,  and  T 
if  condition  does  hold. 


.**»**       Side  Effects:  none 

.  *  *  *  A  * 

(defun  bdry-condition-1  (XI  Yl  X2  Y2) 

(cond  ;  Boundary  condition  1: 

( (or  (<  2  (abs  (-  XI  X2) ) )  ;  If  cells  are  more  than  2  cells 

(<  2  (aba  (-  Yl  Y2)))))        ;  apart,  return  "true" 
(t  nil) ) ) 

*****  Function  "bdry-condition-2" 

*****   Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 

***«♦   Returned:  nil  if  condition  does  not  hold,  and  T  if 

*****     condition  does  hold. 

*****   Side  Effects:  none 

***** 

(defun  bdry-condition-2  (XI  Yl  X2  Y2) 
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(cond 
(  (and 

(=  1  (+  (abs  (-  XI  X2) ) 

(abs  (-  Yl  y2) ) ) ) 
(not  (equal  (list  XI  Yl) 

(aref  *cell*  X2  Y2  1) ) ) 
(not  (equal  (list  X2  Y2) 

(aref  *cell*  XI  Yl  1) ) ) 
(=  1  (bit  *boundary* 

(min  XI  X2) 
(min  Yl  Y2) 

(cond  (  (=  0  (-  Yl  Y2)  )  0) 
(t  1)  )  )  )  ) 


;  Boundary  condition  2: 

;  If  cells  are  adjacent. 


;  and  one  is  not  the 
;  parent  of  the  other. 


;  and  bdry  bit  is  set. 


't) 
(t  nil))) 


;  then  return  "true" 
;  else  return  "nil" 


*****  Function  "bdry-condition-3"  checJ'.s  if  points  are  separated 
*****   j-,y  exactly  one  obstacle  or  river  cell.   If  so,  under  the 
circumstances  in  which  cond-3  will  be  called,  they  are  in 
different  regions. 

Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 
Returned:  nil  if  condition  does  not  hold,  and  T 

if  condition  does  hold. 
Side  Effects:  none 

NOTE:  nested  cond' s  are  arranged  as  they  are  to  detect  as  soon 
as  possible  when  the  conditions  will  not  hold,  because  this  test 
must  be  run  4  times  for  every  cell  in  the  map,  and  only  occasionally 
will  the  =2,=0  conditions  be  true. 


**  *  *  * 

*  *  *  A  * 

*  *  *  *  * 

*  *  *  *  * 

*  *  A  *  A 

*  A  *  A  * 
A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 

A  A  A  A  A 


I  A  A  A  A 


(defun  bdry-conditiori-3  (XI  Yl  X2  Y2) 
(cond 

(  (and  (■=  2  (abs  (-  XI  X2)  )  ) 
(=  0  (-  Yl  Y2)  )  ) 
(cond 


If  cells  are   2  apart  horizontally, 
and  0  apart  vertically,  and 
if  cell  between  them  is  an  obstacle 
or  river,  ttieir  children  are  in 
different  regions. 


((or  (char-equal  l\x  (aref  *cel]*  (/  (+  XI  X2)  2)  Yl  2)) 

cell*  (/  (+  XI  X2)  2)  Yl  2)  )  ) 


(char-equal  #\r  (aref 
'  t )  )  ) 
( (and  (=  0  (-  XI  X2) ) 

(=  2  (abs  (-  Yl  Y2) ) ) ) 
(cond 

((or  (char-equal  #\x  (aref  *cel]*  XI 
(char-equal  #\r  (aref  *cell*  XI 
't)  )  ) 
(t  nil) ) ) 


Same  as  above  for  2  apart  vertically 
and  0  apart  horizontally. 


(/ 

(+ 

Yl 

Y2) 

2) 

2)) 

(/ 

(+ 

Yl 

Y2) 

2) 

2))) 
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...    _»_  Mode:  LISP;  Syntax:  Common- Lisp;  Package:  USER  -*- 
.«****************«**«******************«**************♦************* 

;*****  "utils.lisp"  contains  several  utility  functions  used  by  "opm" 
;*****  found  in  file  "opm. lisp"  and  related  functions. 

*  A  A  *  A  * 

.AAAAA  Current  as  of  7  Jun  89 

•  A  A  A  A  A 

.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
•AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 


•  A  A 

» 

.  A  A 

t 

•  A  A 

f 

.   A  A 

.  A  A 
f 

■   A  A 
f 

>  A  A 
f 

(de 


AAA 
AAA 
AAA 
AAA 
AAA 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

AAA  Tunction  "on-line-incl-betwe 
is  between  the  second  and 
Arguments:  X  S  Y,  XI  &  Yl, 
Returned:  non-nil  if  (X,Y) 

or  nil  otlierwise. 
Side  Effects:  none 
fun  on-line-incl-between  (X  Y  XI 
(cond  ((and  (=  X  XI)   (=  Y  Yl))) 
(  (and  (=  X  X2)   (=  Y  Y2)  )  ) 
(  (and  (or  (<  XI  X  X2) 
(>  XI  X  X2) ) 
(or  (<  Yl  Y  Y2) 

(>  Yl  Y  Y2) ) 
(=  (/  (-  Y  Yl) 
(-  X  XI)  ) 
(/  (-  Y  Y2) 

(-  X  X2))  )  )  ) 
(  (and  (=  X  XI  X2) 


(or 

(<  Yl  Y 

Y2) 

(>  Yl  Y 

Y2) ) ) ) 

( (and  (=  Y 

Yl  Y2) 

(or 

(<  XI  X 

X2) 

(>  XI  X 

X2)))) 

(t  nil) ) ) 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

en"  determines  whether  the  first  point 

third,  inclusive. 
X2  &  Y2,  coords  of  three  points 
is  strictly  btwn  (XI, Yl)  S  (X2,Y2), 


Yl  X2  Y2) 

If  (X,Y)  =  (XI, Yl)  or 
(X,Y)  ■=  (X2,Y2),  return  T 
If  (X,Y)  is  strictly 
inside  the  rectangle 
formed  by  the  line 
endpoints,  check  by 
comparing  slopes  whether 
point  is  on  line. 


;  If  line  is  vertical,  check  by 
;  comparing  Y  coordinates. 

;  If  line  is  horizontal,  check  by 
;  comparing  X,  coordinates. 

;  Else  return  NIL 


A  A 

A  A 

A  A 

A  A 

A  A 

A  A 


(d- 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

***  Function  "on-line-between" 
is  strictly  between  the 
Arguments:  X  &  Y,  XI  S  Y 
Returned:  non-nil  if  (X, 
or  nil  otherwise. 
***    Side  Effects:  none 
fun  on-line-between  (X  Y  XI  Yl 
(cond  ((and  (or  (<  XI  X  X2) 


AAA 
AAA 

AAA 
AAA 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

determines  whether  the  first  point 
second  and  third. 

1,  X2  S  Y2,  coords  of  three  points 
Y)  is  strictly  btwn  (XI, Yl)  &  (X2,Y2) 


X2  Y2) 


(>  XI  X  X2) ) 

(or  (<  Yl  Y  Y2) 

(>  Yl  y  Y2) ) 

(-  (/  (-  Y  Yl) 

(-  X  XI) ) 

(/  (-  Y  Y2) 

(-  X  X2)  )  )  )  ) 

(  (and 

(=  X  XI  X2) 

(or  (<  Y]  Y  Y2) 

(>  Yl  Y  y2) ) ) ) 

(  (and 

(=  Y  Yl  Y2) 

(or  (<  XI  X  X2) 

(>  XI  X  X2) ) ) ) 

(t  ni 

1))) 

If  (X,Y)  is  strictly 
inside  the  rectangle 
formed  by  the  line 
endpoints,  check  by 
comparing  slopes  whether 
point  is  on  line. 


;  If  line  is  vertical,  check  by 
;  comparing  Y  coordinates. 

;  If  line  is  horizontal,  check  by 
;  comparing  X  coordinates. 

;  Else  return  NIL 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAi 

AAAAA  Function  "magnif y-pixel "  takes  a  pair  of  pixel  coordinates 


228 


*  A  *  *  * 

*  *  *  #  * 


.*****    anj  returns  coordinates  which  are  k  times  magnified. 

.*****         Argument:  Pixel,  a  list  of  two  numbers,  and  K,  the  magnification. 

.*****  Returned:  a  list  of  two  numbers,  each  number 

.***«*      being  K  times  the  original. 

.*****    Side  Effects:  none 

(defun  magnif y-pixel  (Pixel) 

(list  (*  'magnification*  (first  Pixel)) 

(*  *magnif ication*  (second  Pixel)))) 

.**************♦*****♦********************************♦************** 
;*****  Function  "magnif y-pixel-list "  takes  a  list  of  pixel  coordinates 
.*«***    and  returns  a  list  which  is  k  times  magnified. 
.*«***    Argument:  Pixel-list,  a  list  of  lists  of  two  numbers  each, 
.**♦**      arij  p;^  (-he  magnification. 

.*****         Returned:  a  list  of  lists  of  two  numbers,  each  number 
.*****  being  K  times  the  original. 

.**«**    Side  Effects:  none 
(defun  magnif y-pixel-list  (Pixel-list) 
(cond  ((null  Pixel-list)  nil) 

(t  (cons  (list  (*  *magnif ication*  (first  (first  Pixel-list))) 

(*  *magnif ication*  (second  (first  Pixel-list)))) 
(magnif y-pixel-list  (rest  Pixel-list) ) ) ) ) ) 

*****  Function  get-backpath  finds  a  cell's  parent,  and  gives  the 
*****   pixels  from  the  cell  to  the  parent,  including  the  cell. 
Tills  version  only  works  for  *magnif*  =  2  or  3 
Arqviment  :  X  S  Y,  coords  of  cell  whose  backpath  is  required 
*****   Returned:  a  list  of  pixel  coords 

*****   Side  Effects:  none 

***** 

(defun  get-backpath  (X  Y 

&aux  Farent-cell  Xm  Ym    Xp  Yp) 
(cond  ((null  (aref  *cell*  X  Y  1))  nil) 
(t 

(setq  Parent-cell  (magnif y-pixel  (aref  *cell*  X  Y  1))) 

(setq  Xp  (first  Parent-cell)) 

(setq  Yp  (second  Parent -cell ) ) 

(setq  Xm  (*  *magni f icat ion*  X)) 

(setq  Ym  (*  *magnif ication*  Y) ) 

(list  (list  Xm  Ym) 

(list  (+  Xm  (/  (-  Xp  Xm)  *magnif icat ion* ) ) 

(+  Ym  (/  (-  Yp  Ym)  *magni f icat i on* ) ) ) 
(list  (+  Xm  (*  2  (/  (-  Xp  Xm)  *magnif ication* )) ) 

(+  Ym  (*  2  (/  (-  Yp  Ym)  'magnification*)))))))) 


.««*****«*<****«*****************«*******«********«************«***** 

r 

;*****  Function  get-all-backpaths  finds  the  backpaths  from  every  cell 
.*****   Q,,  the  map  and  puts  them  in  pixel  form  into  *backpath-pixel-list ' 
(defun  get-all-backpaths  () 

(setq  *backpath-pixel-l i St  *  nil) 
(do  (  (J  1  (1+  J) )  ) 

((string-equal  "eof"  (aref  'mapline*  J))  'backpath-pixel-list * ) 
(do  (  (I  1  (1+  I)  )  ) 

( (=  (length  (aref  *mapline*  1))  I)) 
(setq  *backpa t h-pixel - 1 ist * 
(append 

(get-backpath  I  J) 
*backpath-pixel-list  *)  )  )  ) ) 

******************************************************************** 
'***•  Function  set-equal  checks  if  two  sets  are  the  same. 


*  *  *  *  * 


Arguments:  Setl  and  Set2,  two  lists  treated  as  sets, 
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.»♦**»    Returned:  T  if  Setl  and  Set2  are  the  same,  disregarding 
.»»»**  repeated  elements,  NIL  otherwise, 

(defun  set-equal  (Setl  Set2) 

(cond  ((and  (subsetp  Setl  Set2) 

(subsetp  Set2  Setl))) 
(t  nil))) 

;*****  Function  print-opl  is  a  debugging  function  to  print  the  OPL 
.*****      Qf  a  cell  to  the  screen, 
(defun  print-opl  (X  Y) 

(cond  ((equal  *goal*  (list  X  Y) ) ) 

(t  (print   (are!  * ce 1 1  *  X  Y  3)) 
(prinl  (aref  *cell* 

(first  (aref  *cell*  X  Y  3)) 
(second  (aref  *cell*  X  Y  3)) 
2)) 
(print-opl  (first  (aref  *cell*  X  Y  3)) 

(second  (aref  *cell*  X  Y  3)))))) 

;*****    Function  "linefeed"  is  a  mnemonic  for  terpri . 

.*«***    Side  Effects:  causes  a  carriage  return  to  be  sent  to 

.♦****      the  output  stream. 

(defun  linefeed  () 

(terpri) ) 
(defun  linefeed2  () 

(terpri  *output-st ream* ) ) 


.*************************************************************A****** 

;*****  Function  "report-completion"  sends  a  message  to  the  screen 

(defun  report -complet ion  () 
(linefeed) 

(princ  "Wavefront  expansion  complete")   (linefeed) 
(princ  "Type  (l^ill-windows)  to  remove  screen")  (linefeed)  't) 


.**A*******A**************************A*************************A****A** 

;*****  Function  sort -condition  determines  the  order  between 
;*****    two  cells  on  the  wavefront. 
.««***    Arguments:  two  sets  of  coordinates 

.**♦**    Returned:  TRUE  if  remaining  cost  of  first  cell  is  less  than 
.**»**      remaining  cost  of  second. 
.*****    Side  Effects:  none 
(defun  sort -condit ion  (Celll  Cell2) 
(let  ( (XI  (first  Celll)  ) 
(Yl  (second  Celll)  ) 
(X2  (first  Cell2) ) 
(Y2  (second  Cell2) ) ) 
(<  (aref  *cell*  XI  Yl  0) 

(aref  *cell*  X2  Y2  0) ) ) ) 
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; ; ;  -*-  Mode:  LISP;  Syntax:  Common-Lisp;  Package:  USER  -*- 

.*AAA*AAAA*AA**AAA**AAAAA**A*AAAAAA**AA*AA**AAAAAA*AAA*A******A********A 
I 

•  AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
/ 

;*****   File  "graphics"  contains  the  functions  to  open  a  window  for 
;*****   displaying  the  terrain,  wavefront,  boundaries,  and  back-paths. 
.AAAAA   jj^  £g  adapted  from  file  "graph. lisp"  written  by  Dr.  Se-Hung  Kwak 

.  A  A  A  A  A 


.AAAAA   Current  as  of  13  May 


>  A  A  A  A  A 
f 

.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
•  AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

(defvar  *display-window* ) 

(defvar  *draw-window* ) 

(defvar  *draw-window-ar r ay* ) 

(defvar  *draw-window-width* ) 

(defvar  *draw-window-height * ) 

(defvar  *draw-window-inside- width*) 

(defvar  *draw-window-inside-height*) 

(defvar  *draw-window-position* ) 

(defun  ini t ialize-graphics  () 
(initialize- windows) 
(clear-window) 
(draw-goal ) 

(draw- features  *terrain-pixel-li3t*) 
(make-visible) ) 

(defun  dr aw-and-show-window  () 

(mapcar  ' draw-pt  *boundary-pixel-3 ist * ) 

(mapcar  'draw-pt  *backpath-pixel-list * ) 

(make-visible) 

(setq  *backpath-pixel-list *  nil)) 

(defun  draw-and-show-bdry-window  () 
(clear-window) 
(draw-goal ) 

(draw- features  * terrain-pixel-list* ) 
(mapcar  'draw-pt  *boundary-pixel-list * ) 
(make-visible)  ) 

(defun  draw-and-show-backpaths  () 
(clear-window) 
(draw-goal ) 

(draw-features  (get-all-backpaths) ) 
(make-visible) 
't) 

(defun  show-boundary  () 

(mapcar  'draw-pt  *boundary-pixel-list * ) 
(make-visible) 't) 

(defun  show-terrain  () 

(draw- feat  tires  *terrain-pixel-list*) 
(make-visible)  't) 

(defun  show-goal  () 
(draw-goa 1 ) 
(make-visible)  't) 

(defun  show-barkpat h.«i  () 

(draw-f  eat\ires     (get-all-backpattis)  ) 
(make-vi  siblf")     't) 

(rtf?  f  uii     ini  t  i  al  i  7,e-wi  iirlowp  ( ) 
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(princ  "Initializing  Windows")  (linefeed)  (linefeed) 

(setf  *draw-window-width*  650) 

(setf  *draw-window-height *  500) 

(setf  *draw-window-po3ition*  '  (75  75)) 

(setf  *display-window* 

(tv  :ma)ce-window  'tv:window 

:blin)cer-p  nil 

:position  *draw-window-position* 
:width  *draw-window-width* 
:height  *draw-window-height * 
: name  "display-window" 
:save-bit3  t 
: expose-p  t ) ) 
(setf  *draw-window* 

(t  V  :ma)^.e-window  'tv:window 

iblinVier-p  nil 

:position  *draw-window-position* 
:width  *draw-window-width* 
:height  *draw-window-height * 
iname  "draw-window" 
:save-bits  t 
: expose-p  nil) ) 
(setf  *draw-window-ar ray * 

(send  *draw-window*  :bit-array)) 

(setf  *draw-window-inside-height *   -„ 

(send  *draw-window*  : inside-height) ) 
(setf  * draw-window- inside-width* 

(send  *draw-window*  : inside-width) ) ) 

(defun  clear-window  0 

(tv: sheet -force-access  (* draw-window*) 
(send  *draw-window*  : refresh) ) ) 

(defun  draw-goal () 

(tv: sheet- force-access  (  *d raw- window* ) 
(send  *draw-window*  :draw-string  "*" 

(-  (*  *magni f icat ion*  (first  *goal*))  3) 

(+  (*  'magnification*  (second  *goal*))  5)))) 

(defun  make-visible ( ) 

(send  *display-window*  :bitblt 
tv : alu-set a 

* draw-window- inside- width* 
*draw-window-inside-height * 
*dr aw- window-array  * 
2  2  0  0)) 

(defun  ki 1 1-windows ( ) 

(send  *di splay-window*  :kill) 

(send  'draw-window*  :kill) 

(linefeed)  (princ  "Windows  Killed")  (linefeed)  (linefeed)) 

(dofun  draw- features  (Fixel-list) 

(do  (  (P.est-of-list  Fixel-list  (rest  Rest-of-list )  )  ) 
((null  Pest-of-list) ) 
(draw-pt  (first  Rest-of-list)))) 


(defun  draw-pt   (poi nt -coords ) 

(tv:she<»t-force-acceps  ('draw-window') 
(send  'draw-window* 

:draw-point  (first  point-coords)   (second  point-coords))) 
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APPENDIX  D  -  HIGH-COST  EXTERIOR-GOAL  IICA 
INTERIOR-BOUNDARY  CONSTRUCTION  SOURCE  CODE 

A*AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA*AAAAAAAAAAAAA*AA*AAAAAAAAA*AAAAAAAAA*A*A 

* 

*  FiJe  "hdrygen". 

*  Updated  12  Jan  89. 

* 

*  This  program  generates  boundaries  for  HCA  interiors 

*  and  writes  them  t  r,  two  files;  "bdry  out"  is  a  file  of  prolog 

*  facts  recording  tlie  boundary  and  terrain  information; 

*  "bdry_fig"  is  the  same  info  ready  for  plotting  by  the  "figure"  utility. 

*  Requires  "bgmapdata",  "bgutils",  "bgplotter",  and  "bdryjoin" 

*  to  be  in  the  same  directory  when  started. 

*  Usage:   from  unix,  type: 

*  prolog 

*  I bdrygen ] . 

*  bg. 

*  halt. 

A 

********A***AA**A*A*A***AAA*A*AAAA*AAA*AA*A**A***AA*****A****************A* 

**A*AA***AA*AAAAAAA*A*AA*A**AAA*A*AAAA*A****AAAAAAA*A*A******AAA*A**AAAAAA*/ 

bg  :-    asser t (write_fl ag (write) ) ,    /*  or  (write_f lag (no_write) )  */ 
initialize  bg, 
gener atebdrys, 
save (bgstate) , 

tell (user ), nl , wri te (' Boundary  generation  done  (First  Pass) ' ) , nl, nl , 
reconsult (bdryjoin) , 
bdry  join . 

bg2  :-   generat e_bdrys, 

t'^11  (user),  write  ('Boundary  yeneration  done  (.Second  ras3)'),nl, 
bdry_ join . 

gcrierate_bdry3     :- 

goa]_point  (Xg,Yg)  , 

regi"n_vertices ((Xl,Yl,X2,Y?|FListl]), 

con.s  ((X1,Y1,X2,Y2|  RList  1  )  ,  [  XI  ,  Y  1  ]  ,  RLi  st  2  )  , 

initial_output ( (Xq, Yg) , RList2,_) , 

classif y_edges  (P List  2,  (Xq, Yq J , PList  3)  , 

convert_vl  i  st  to  el  ist  ( 1 ,  Pl.i  st  3,  RList  4  )  , 

assert (region_elist (RList4) ) , 

gener ate_boundariesO (RList4 , [ Xg, Yg ) ) , 

order  initbdry  indices,   ! . 

/♦ 

*  TemporariJy,  file  "bgmapdata"  must  have  a  predicate  for  each 

*  vertex  witli  its  optimal  patli  list.   Eventually,  this  should  I'e 

*  if^placed  t.'y  a  cali  to  a  pat  li- f  i  ndi  ng  program  such  as  "sis"  oi  "iri" 

*/ 

/•Compare     lot     erlqe    w/    2d,  3d..,     recutse    to    comp    2d    edge    w/     3d,  4 1  h .  .  ,  et  c*  / 
aener  al  e    b'M.iidar  iPsO  (  (XI  ,  Yl  ,  V]  2,  III  2,  X2,  Y2)  ,  (Xq,Yg])  . 
genorate_boundaciesO  ((Xl,yi,V12,N12,X2,Y2|Rest),  |Xg,YqJ)      :- 

gene  rat  eboundar  i  es  (  (  XI ,  Y 1 ,  V12,  t)l  2  ,  X2,  Y2  |  Rest  J  ,  (  Xg,  Yg  J  )  , 

q'^iir-rate    bounria  r  i  r-sO  (Re.st  ,  (Xg,Yq))  . 

/*    ."^topping    condition:     only'    cue    f»dqe    left     */ 
qenerate_boundaries(|,_,,,_,_),l,_l)      :-     !. 

/*     If    vertex    list     from    fiie     "bgmaprlat  a "    already    incluvl'*.''    Mi<^     • /' 

/*     first      point     a?    th"     last,      it     will     app^'ar     twice,      so    iqn'''r''        */ 

/*    Llie    second    occurence.     '/ 
geiieiai."    Iioundar  ies  (  |  Xa,  Ya,     ,     ,  Xb,  Yl  ,  Xa,  Ya,     ,     ,Xb,YbJ,l     ,      ))      :-     '. 
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/*  Type  1  */ 
generate_boundarie3 ( (Xa, Ya, v, Nab, Xb, Yb, Xc, Yc, v, Ned, Xd, Yd | Rest ) , [Xg, Yg] )   :- 

interior_co3t  (Ci) , exterior_cost  (Ce) ,  /*  2via  (Typel)  bdry  */ 

plot_2vi3_bdry (Ci , Ce, Xa, Ya, Nab, Xb, Yb, Xc,  Yc,  Ned, Xd,  Yd) ,  /*plot  Edgel, E2*/ 
generateboundaries ( (Xa, Ya, V, Nab,Xb, YblRest ] , [Xg,Yg)) .   /* [El , E3 | Rest ) */ 

/*  Type  2  */ 
generateboundaries ( (Xa, Ya, v, Nab, Xb, Yb, Xc, Yc, h (F) , Ned, Xd, Yd | Rest ) , (Xg, Yg) )  :- 

inter ior_co3t (Ci) , exterior_cost (Ce) ,  /*  Ivis  (Type  2)  */ 

plot_lvi3_bdry (F, Ci , Ce, Xa, Ya , Nab, Xb, Yb,  Xc,  Yc,  Ncd,Xd,  Yd)  ,  /*plot  E1,E2*/ 
generateboundaries ( (Xa, Ya, V, Nab, Xb, YblRest) , (Xg,Yg)) .  /* (El , E3 | Rest ) * / 

/*  Types  3  and  4  */ 
generate_boundarie3 ( (Xa, Ya, h (F) , Nab, Xb, Yb, Xc, Yc, h (G) , Ned, Xd, Yd  I  Rest  ]  ,  (Xg, Yg) )  :- 
interior_co3t (Ci ) , exter ior_co3t (Ce) ,  /*  Ovis  (Type  3  or  4)  */ 

plot_Ovis_bdry (F, G, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd) ,  /*plot  El, 2*/ 
generateboundaries  (  (Xa, Ya, h  (F)  , Nab, Xb, YblRest ) ,  (Xg, Yg) )  .   /* ( El , E3 | R) * / 

init ial i7e_bq  :- 

consult  (bgniapdata)  , 

consult (bgutils) , 

consult (bgplotter) , 

tell(uger),nl,nl,nl, 

write  (' Boundaries  being  computed: ' ) , nl,  !  . 

initial  out put ( (Xg, Yg ), Region, Region_eli st )   :- 
assertz  (title  ('')), 
title (Title) , 

wr i te_to_bdry_f ile (t it le, Title) , 
write_to_bdry_f ile (goal, (Xg, Yg] ) , 
write_to_bdry_f ile (region, Region) , 

/*  wr ite_to_bdry_f ile (region_elist , Region_elist ) , 
wr it e  to_f igf ile (title) , 
writeto_f i  g_f ile (goal,  (Xg,Yg)), 
write_heading (region) , 
write_to_f ig_f ile (region, Region)  ,  */ 
!  . 

/*  convert  list  of  vertices  (vertices  are  not  repeated)  to  a  list 

*  of  edges  (a  vertex  appears  once  for  each  edge) 

*  Also  number  the  edges  sequentially,  and  assert  the  number  of  edges. 
*/ 

convert_vlist_to_elist (N, (XI , Yl , VI , X2, Y2 ] , (XI , Yl , VI , N, X2, Y2 ) )  :- 

assert (number_of _edges (N) ) . 
convert_vli3t_to_elist (N, (Xl,Yl,o,X2, y2 | RListRest ) , 

(Xl,Yl,o,o,X2,Y2| RevRListRest ) )  : - 

convert_vlist_to_eli3t (N, (X2, Y2 (RListRest) , RevRListRest ) ,  ! . 
convert_vlist_to_eli3t (N, (X1,Y1,V1,X2,Y2 (RListRest) , 

(XI, Yl, VI, N,X2, Y2 (RevRListRest) )  :- 

Nplusl  is  N  +  1, 

convert_vlist_to_elist (Nplusl, (X2, Y2 | RListRest) , RevRListRest) ,   ! . 

classi f y_edges (LI , ( Xg, Yg ) , L6)   :- 

edge_visibility_cheek (LI, (Xg, Yg) , L2) , 

rotate_edg<»_li  st  (L2,  L3)  , 

mark_edges  (L3  ,  L*! )  , 

insert _opposite_pt (L4, L5) , 

remark_edges (L5, L6)  ,   !  . 

/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
remark_edge3 ( [XI, Yl, V, X2, Y2 I  Rest ) ,  ( XI , Yl , v, X2, Y2 | Rest  2 ] )  :- 

remark_edges ( I X2, Y2 | Rest )  ,  [X2, Y2 | Rest 2 ] )  . 
/♦  How  step  past  h (b)  edges.  */ 
remark  edges ( ( XI  ,  Y 1,  h (b)  ,  X2  ,  Y2 | Rest ) ,  [ XI , Y 1 ,  h (b)  ,  X2  ,  Y2 | Rest  2 ) )  :- 


step  past  h (D)  edges.  ' / 

edges ( ( XI , Y 1, h (b) , X2 , Y2 | Rest ) , [ XI , Y 1 , h (b) , X2 , Y2 | Rest : 
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remarkedges ( (X2, Y2 IRest] , (X2, y2 | Rest2 ) ) . 
/*  At  each  h(ob)  edge,  change  ' ob'  to  ' b'  */ 
remark_edge3 ( [XI , Yl , h (ob) , X2, Y2 | Best ] ,  [Xl , Yl , h  (b)  , X2, Y2 | Re3t2 ] )  :- 

remark_edge3 ( (X2, Y2 IRest J , |X2, Y2 | Re3t2 ) ) . 
/*  At  each  h(oa)  edge,  change  'oa'  to  'a'  */ 
remark_edge3 ( (XI , Yl , h (oa) , X2, Y2 | Rest ) , (XI , Yl , h (a) , X2, Y2 | Rest2 ) )  :- 

remark_edges ( (X2,Y2 IRest] , (X2, Y2 | Rest2 ] ) . 
/*  At  first  h(a)  edge,  stop.  */ 

remarkedges ((Xl,Yl,h(a),X2,Y2|Rest3, (Xl,Yl,h(a),X2,Y2|Rest]) . 
/*  If  no   h(a)  edges,  stop.  */ 
remark_edge9  (  (X, YJ ,  (X, Y] )  . 

in9ert_opposite_pt (L4, L5)  :-  /*  On  first  pass,  assume  no  shortcutting  */ 

not ( f irst_pass_done) ,  /*  occurs  and  set  up  opposite  point  */ 

insert  tentative_opp  pt(L4,L5),    /*  and  optimal  paths  accordingly.    */ 
assert_pseudo_ops (L5) ,  ! . 

insert_opposit e_pt (L4 , L5)  :-  /*  On  second  pass,  use  correct  opp  point  */ 

f irst_pass_done, 
insert_correct_opp_pt (L4, L5) ,  ! . 

/*  On  FIRST  PASS,  insert  tentative  opposite  point  at  the  midpoint  of  */ 

/*  the  opposite  edge3,  disregarding  any  possible  shortcutting.  */ 

/*  Change  marking  on  other  ' o'  edges  accordingly.  */ 

/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 

insert_tentative_opp_pt ((Xl,Yl,v,X2,Y2|Rest), (Xl,Yl,v,X2,Y2|Rest2])   :- 

insert_tentative_opp_pt ( (X2, Y2 | Rest ) , (X2, Y2 | Rest2 ) ) . 
/*  Now  step  past  h(b)  edges.  */ 
insert_tentative_opp_pt ( (XI , Yl , h (b) , X2, Y2 | Rest ] , (XI , Yl, h (b) , X2, Y2 | Re3t2 ) )   :- 

insert_tentative_opp_pt  ((X2,Y2|Rest),  (X2,Y2|Rest2])  . 
/*  At  first  h  (o)  edge,  branch  to  insert.  .2,  passing  opp  edge  info  along.  */ 
in3ert_tentative_opp_pt ((Xl,Yl,h(o),X2,Y2|RestJ, RevisedL)  :- 

optimal^path ( (XI, Yl |OFl] , Cccw) , 

in3ert_tentative_opp_pt2 ((Xl,Yl,h(o),X2,Y2|Rest],(Xl,Yl] , Cccw, RevisedL) . 
/*  If  there  is  no  h(a)  edge,  go  to  insert.. 3,  then  stop  at  last  h(o)  edge  */ 
/*  opposite  point  in  previous  ' o'  edges.  */ 
insert_tentative_opp_pt2 ((Xl,Yl,li(o),X2,Y2]  ,  OF, Cccw, R2)   :- 

insert_tentative_opp_pt3 (X2,Y2, (X2,Y2,h(o) |OEJ,Cccw,R2) . 
/*  At  each  h (o)  edge,  pass  opp  edge  info  along.  */ 
in9ert_tentative_opp_pt2 ((Xl,Yl,h(o),X2,Y2|R] ,OE,Cccw, R2)  :- 

insert_tentative_opp_pt2 ( (X2, Y2 |R) , (X2,Y2,h(c)  jOE) , Cccw, R2) . 
/*  At  first  h  (a)  edge,  insert  Ist-guess  opposite  pt  in  previous  'o'  edges.  */ 
insert_tentative_opp_pt2 ((Xl,Yl,h(a),X2,Y2|R] , OE,  Cccw, OandAList )  :- 

optimal_path ( (XI, Yl jOPcw] , Ccw) , 

rever se_edge_list (OE,OERev) , 

edge_length (OERev, Length) , 

D  is  (Length+Ccw-Cccw) /2,    /*  opp  pt  is  D  along  the  OEs  ccw  from  ptl  */ 

inser t_terit_opp_pt_aloiig_edges  (OERev,  D,  OERevised)  , 

cons (OEPevised, (h (a) , X2, Y2 | R] , OandAList ) . 
/*  If  there  are  no  h(a)  edges,  insert  Ist-guess  opp  pt  in  previous  ' o'  edges.  */ 
in9ert_tentative_opp_pt3 (Xl,Yl,OE,Cccw,  OandAList)  : - 

optimalpath ( (XI , Yl j OPcw) , Ccw) , 

rever se_edge_list (OE, OERev) , 

edge_length (OERev, Length) , 

D  is  (Length4Ccw-Cccw) /2,    /*  opp  pt  is  D  along  the  OEs  ccw  from  ptl  * / 

insert_tent_opp_pt_along_edges (OERev, D, OandAList ) . 

inser t_tent_opp_ptalong_edges ((Xl,Yl,h(o),X2,Y2|OE],D, (XI,Yl,h(ob) | OERev] )   :- 

distance  (XI, Yl, X2, Y2, Dl)  ,  D2  is  D  -  Dl, 

D2  >  0, 

insert_tent_opp_pt_along_edges ( (X2, Y2  jOE]  ,  D2, OERev)  . 
insert_tent_opp_pt_along_edges ( (XI , Yl , h (o) , X2,  Y2 | OE ]  ,  D, 

(XI, Yl, h  (ob)  ,Xopp, Yopp, h (oa)  | OERev] )   :- 

distance (XI, Yl, X2, Y2, Dl) ,  D2  is  D  -  Dl, 

02  =<  0, 


239 


DelX  is  X2  -  XI,  DelY  is  Y2  -  Yl, 

Xopp  is  XI  4  DelX*(D/Dl),  Yopp  is  Yl  +  DelY*(D/Dl), 

assert (oppositepoint (Xopp, Yopp) ) , 

change_o_to_oa ((X2,  Y2 |OE]  ,OERev)  . 

change_o_to_oa ( (X, YJ , (X, Y) )  :-  !. 

changeotooa  (  (XI ,  Yl ,  h  (a)  ,  X2,  Y2  |  OE  )  ,  |  XI ,  Yl ,  Ji  (a)  ,  X2,  Y2  |  OE]  )  :-  !  . 
chaiigeotooa  (lXl,Yl,li(o),X2,Y2|OE],lXl,Yl,li(oa),X2,Y2  jUERev]  )   :- 
changeotooa { 1X2, Y2 |OE) , 1X2, Y2 |OERev] ) ,  ! . 

/*  At  each  vertex  along  tentative  opposite-edge  sequence,  assert  a  */ 

/*  pseudo-optimal-path  as  if  no  shortcutting  occurred  */ 

/*  First  step  past  visible  edges  */ 

a3  3ert_pseudo_ops ((Xl,Yl,v,X2,Y2|Rest))  :- 

assert_pseudo_ops ( ( X2, Y2 | Rest ] ) . 
/*  Now  step  past  'before'  edges  */ 
assert_pseudo_ops (lXl,Yl,h(b),X2,Y2|Rest])  :- 

as3ert_pseudo_ops ( [X2, Y2 | Rest ] ) . 
/*  At  first  'opposite'  edge  */ 
assert_pseudo_ops ( [XI, Yl, h (ob) ,X2, Y2 |Rest] )  :- 

optimalpath ((Xl,Yl|OPl}), 

assert  (pseudo_opt  inial_path  ([Xl,Yl|OPl))), 

exterior_co3t (Ce) , 

assert (pseudoopt imalpath ( [X2 , Y2, c (Ce) , XI , Yl | OPl ) ) ) , 

assert  pseudo_ops2 ( ( X2 , Y2 | Rest  J )  . 
/*  At  subsequent  'opposite'  edges  */ 
assert_pseudo_ops2 ( [XI , Yl , h (ob) , X2, Y2 | Rest ) )  :- 

not (opposite_point (XI, Yl ) ) , 

pseudo_optimal_path ( [XI, Yl |Ori ) ) , 

exterior_cost  (Ce) , 

assert (pseudo_opt imal_pat h ([X2,Y2,c(Ce),Xl,Yl|OPl))), 

assert_pseudo_ops2 ([X2,Y2|Rest]) . 
/*  At  edge  with  'opposite  point'  */ 
assert_pseudo_ops2 ([Xl,Yl,h(oa),X2,Y2|Rest])  :- 

opposite_point  (XI, Yl)  , 

as3ert_pseudo_ops3 ( [X2, Y2 | Rest ) ) , 

pseudo_optimal_path ( (X2, Y2 |OP2 ) ) , 

exterior_co3t (Ce) , 

assert (pseudoopt imalpath ( [XI , Yl , c (Ce) , X2, Y2 |OP2] ) ) . 
/*  If  there  are  no  'a'  edges,  assert  clockwise  OP  at  vertex  and  stop.  */ 
assert_p3eudo_op33 ( [Xl, Yl ] )  :- 

optin\al_path  (  (  XI ,  Yl  |  OPl )  )  , 

assert  (pseudo_opt imalpath  ([X1,Y1|0P1]))  . 
/*  Search  to  end  of  'o'  edges,  asserting  clockwise  OP  at  each  cw  vertex  */ 
as3ert_pseudo_ops3 ([Xl,Yl,h(oa),X2,Y2|Re3tJ)  :- 

assert_pseudo_ops3 ( [X2, Y2 | Rest ] ) , 

pseudo_optimal_path ([X2,Y2|OP2]), 

exterior_cost (Ce) , 

assert (pseudo_opt imal_path ([Xl,Yl,c(Ce) ,X2,Y2IOP2J) ) . 
/*  At  first  'after'  edge  assert  a  cw  ps-op  and  stop.  */ 
assert_pseudo_op3  3 ([Xl,Yl,h(a),X2,Y2|Rest))  :- 

optimalpath ((Xl,Yl|OPl)), 

assert (pseudo_opt imal_path ((Xl,Yl|OPl))). 

/*  On  SECOND  PASS,  insert  correct  opposite  point  into  the       */ 
/*  the  opposite  edges,  disregarding  any  possible  shortcutting.  */ 
/*  Change  marking  on  other  ' o'  edges  accordingly.  */ 
/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
insert_correct_opp_pt ((Xl,Yl,v,X2,Y2|Rest), lXl,Yl,v,X2,Y2|Rest2))   :- 

insert_correct_orr_pt ([X2,Y2|Rest], [X2,Y2|Re3t2)) . 
/*  How  step  past  h (b)  edges.  */ 
insert  correct  opp  pt ( [XI , Yl , h (b)  , X2 , Y2 | Rest ) ,  [XI , Yl , h  (b)  , X2, Y2 | Rest 2 ) )  :- 


240 


in3ert_correct_opp_pt ( (X2, Y2 | Reat )  ,  1X2, Y2 lRe3t2] )  . 
/*  At  each  h (o)  edge,  see  if  opp  pt  is  on  this  edge.         */ 
/*  If  so,  revise  rest  of  h (o)  edges  and  insert  opp  pt .      */ 
in3ert_correct_opp_pt ((Xl,Yl,h(o) ,X2,y2|RestJ, 

(XI, Yl, h(ob) ,Xopp, Yopp, h (oa)  ,  X2,  Y2 | Rest2 ] )  :- 

opposite_point (Xopp, Yopp)  , 

on_line (Xopp, Yopp,  Xl,yl,X2,Y2), 

changeotooa ( [X2, Y2 | Rest )  ,  (X2, Y2 | Rest2 ) ) ,  !  . 
/*  If  not,  mark  edge  h(ob)  and  look  at  rest  of  h (o)  edges.  */ 
in3ert_correct_opp_pt ([Xl,Yl,h(o),X2,Y2|Rest),  [Xl,Yl,h(ob),X2,Y2|Rest2))  :- 

insertcorrectopppt  (  (X2, Y2 | Rest  J ,  (X2, Y2 | Re3t2 ) )  . 

/*  Step  thru  edge-list,  rotating  it  until  all  visible  edges  are  on  its   */ 
/*  front,  and  all  hidden  edges  are  on  its  end.  */ 

/*  Upon  finding  a  hidden  edge  before  any  vis  edge,  put  it  on  the  end,    */ 
/*  and  start  again  looking  for  vis  or  hidden  edges.  */ 

rotate_edge_list ([Xl,Yl,h,X2,Y2|RestI,  RevisedList)  :- 

cons ( (X2, Y2 IRest) ,  ( h,  X2,  Y2 ]  ,  L2)  , 

rotate_edge_list (L2, RevisedList)  ,  !  . 
/*  Upon  finding  first  vis  edge,  step  thru  the  list  keeping  vis  edges  in  */ 
/*  order,  and  then  keeping  hidden  edges  in  order.   If  any  vis  edges  are  */ 
/*  on  the  end  of  the  list,  put  them  on  the  front.    */ 

/*  and  if  so,  put  them  on  the  front,  maintaining  order.  */ 

rotate_edge_list  (  [X,Y,v|Re3t] , Full Re vised List)  :- 

rotate_edge_list2 ((X,Y,v| Rest],  RevisedList,  Front of List)  , 

cons  (FrontofList, RevisedList, FullRevisedList )  ,  !  . 
/*  Go  past  the  front-end  visible  edges.  */ 
rotate_edge_list2 ((X],Yl,v,X2,Y2|Rest],(Xl,Yl,v|L2],  FrontofList)  :- 

rotate_edge_li3t2 ( [X2 , Y2 | Rest ]  ,  L2,  FrontofList)  ,  !  . 
/*  Go  past  the  first  hidden  edge  after  the  visible  edges.  */ 
rotate_edge_list2 ( (XI ,Y1, h, X2, Y2 IRest )  ,  [ XI , Yl ,  Ii  | L2 ], FrontofList )   :- 

rotateedge_list3 ( [X2, Y2 | Rest } , L2, FrontofList)  ,  !  . 
/*  Go  past  the  rest  of  the  hidden  edges  after  the  visible  edges.  */ 
rotate_edge_list3 ((Xl,Yl,h,X2,Y2|Rest],(Xl,Yl,h|L2),  FrontofList)  : - 

rotate_edge_list3 ( [X2, Y2 | Rest )  ,  L2,  FrontofList)  ,  !  . 
/*  If  visible  edges  are  found  past  the  hidden  edges,   the  rest  will  also  */ 
/*  be  visible;  send  the  rest  back  up  to  be   put  on  the  front  of  the  list  */ 
rotate_edge_list3 ( (X, Y, v I  Rest  J ,  (X, Y J , FrontofList )  :- 

all_but_la3t_coords ([X,Y,v| Rest], FrontofList),  !. 
/*  Ending  condition.  */ 
rotate_edge_list3  (  [X, Y] ,  [X, Y] ,  [ ) )  :-   !. 

/*  eliminate  the  last  coordinates  and  the  last  edge-vis  flag  */ 
al]_but_last_coord3 ( (X, Y]  ,  (])  . 

all_but_last_coord3 ( [X, Y, V| Rest )  ,  [X, Y, V | RevisedRest ] )  :- 
all_but_last_coords (Rest, RevisedRest) . 

/*  mark  edges  before  (b) ,  after  (a),  or  opposite  (o) ,  based  on  whether  */ 
/*  they  are  before  or  after  the  opposite  edge,  or  undetermined.  */ 
mark_edges (LI  ,  L3)   :- 

mark_edges2 (LI , L2 ) ,  mark_edges3 (L2,  L3 )  ,  asser t_opposite  edqe(L3)  . 
/*  ' mark_edges2 '  marks  ' h (b) '  or  ' h (a) '  based  on  opt  paths  of  edge  itself.  ' 
/*  Base  case  for  'mark  edge32' .  */ 
ma rk_edges2 ((_,_] , (_,_T) . 

/*  First  step  past  vis  edg^s,  leaving  their  markings  unchanged  */ 
mark_edges2  ((Xl,Yl,v,X2,Y2|Rest),  |Xl,yi,v,X2,Y2|Rest2])   :- 

mark_edges2 ( [X2,  Y2 | Rest ]  ,  ( X2,  Y2 | Rest2 J  )  . 
/*  Upon  finding  a  hidden  edge,  check  if  it  is  ' b'  or  'a'  or  'o'  */ 
/*  It  is  'b'  if  opt  path  from  X2,Y2  starts  toward  XI, Yl.      */ 
mark_edges2  ((Xl,Yl,h,X2,Y2|Rest],  (Xl,Yl,li(b),X2,Y2|Rest2])   :- 

optimal_path ((X2,Y2,c(C),Xi,Yi|_)), 

on_ray (Xi,Yi,X2,Y2,Xl,Yl), 

mark_edges2 ( (X2, Y2 IRest ] ,  [X2, Y2 | Rest 2 ] )  . 
/*  It  is  'a'  if  opt  path  from  XI, Yl  starts  toward  X2,Y2.      */ 
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m3rk_edge9  2  ((Xl,Y],h,X7,y2|Rpsf:),  (Xl,Yl,li(a),X2,Y2IRest2])  : - 

optimal_path (IXl,yi,c(C),Xi,Yi|_)), 

onray (Xi,Yi,Xl,Yl,X2,Y2), 

matk_edge32 ( ( X2, Y2 I  Rest ] ,  (X2, Y2 I Rest2 ) )  . 
/*  Otherwise  it  is  potentially  an  opposite  edge,  so  mark  it  with 
mark_edges2 ( (XI, Yl, h,X2, Y2 IRest ) , {XI , Yl , h (o) , X2, Y2 | Re3t2 ) )  :- 

mark  edge  o  2  ((X2,Y2|Rr!nt),  |X2,Y2|Re3t2))  . 


/*  First  step  past  vis  edges  */ 
assert_opposite_edge (lXl,Yl,v,X2,Y2|Re3t])  :- 

assert  oppos it e_edge ([X2,Y2|Rest]) . 
/*  Second  step  past  h(b)  edges  */ 
assert_oppo3ite_edge ((Xl,Yl,h(b),X2,y2|Rest))  :- 

assert_opposite_edge ( 1X2, Y2 | Rest ] ) . 
/*  At  first  opposite  edge,  get  rest  of  opp  edge  and  then  assert  info  */ 
a3sert_opposite_edge (tX],Yl,h(o),X2,Y2|Rest))  :- 

a3  9ert_opposite_edge2 ( [X2,  Y2 | Rest )  ,  Rest2)  , 

assert (opposite_edge ((Xl,Yl,h(o)|Rest2J)),  !. 
/*  At  first  h(a)  edge,  or  at  end  of  list,  stop.  */ 
as9ert_opposite_edge2 ( [X, Y] ,  (X,Y])  . 

assert_opposite_edge2 ([Xl,Yl,h(a),X2,Y2|Rest], [X1,Y1]) . 
/*  At  each  h (o)  edge,  get  rest  and  send  back  opp  edge  vertices  */ 
assert_opposite_edge2 ( [XI , Yl , h (o) , X2, Y2 | Rest ] , [XI, Yl, h (o) |Rest2] )   :- 

assert_oppositeedge2 ( [X2, Y2 | Rest ] , Rest2) ,   ! . 

/****■i******■^^,**^,^,*t^.i■^,^,■^^,^,^,t***^,^,^,^l^,^,^,■),■^^,^,^,■^■^,^>■t,^,^,■^^,^,^,^,^,^,^,^,■^,■),^,^,^,^,^,^,^,^,******^l*/ 

/*  Succeeds  if  1st  pt  is  on  a  ray  from  2nd  pt  to  3rd  pt  between  the  two  pts,  */ 
/*  &  fails  o/w.  Succeeds  if  1st  pt  -  3rd  pt,  fails  if  1st  pt  -  2nd  pt .  */ 
on_ray (X2, Y2,X1, Y1,X2, Y2)  . 
onray (Xi, Yi,Xl, Yl , X2,y2)   :- 

St  ri  ct 1 ybetween (Xi , XI , X2)  , 

strictly_between  (Yi, Yl, Y2)  , 

Yx  is  Xi*  (Y2-yi)  /  (X2-X1)  +  Y2  -  X2 *  (Y2-Y1 ) /  (X2-X1 )  , 

within  tolerance (Xi , Yx, Xi , Yi )  . 
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/*  Binds  UL  to  the  lift  of  opposite  edges.  */ 
get_o_edge3 ((_,_, h (V)  I R)  ,  UL)  :-  oedges (R,  UL)  . 
get_o_edges ([_,_,  h (b)  I RJ  ,  UL)  :-  oedges (R,  UL)  . 
getoedges ( (XI, Yl , h (o) , X2, Y2 | RJ , (XI, Yl, X2, Y2 | RestUL] ) 

get_o_edges ( (X2, Y2 jR]  ,  RestUL)  . 
getoedges ( (_,_, h (a) I R] , ( ) )  :-  get_o_edges (R, ( ) ) . 
get_o_edqes ((_,_).  ( ] )  • 

order_initbdry  indices  :- 

retract  (initbdry((I,Jj,B)), 

sort {[1,J), (12, J2)) , 

asserta (initbdry ( (I, J] ,B) ) , 

fail,   !. 
order_initbdry  indices  :-  !. 
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*******AA*A******A**********************************************A********** 

* 

*  File  "bgplotter"  has  the  predicates  which  plot 

*  boundaries  of  various  types.   It  is  loaded  by  "bg" . 

A 

AA*AAAAAAAAAAAAAA****AAAAA*AAAAAAAAAAAA*AAAAAAAAAAAA*AAAAAAAAAAAAAAAAAAAAAA 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA/ 

/AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

*  This  predic.  plots  2vis/  (Type  1)  boundaries  between  two  HCA  edges,  ie, 

*  between  two  visible  edges 

A 

*  Updated  12  Jan  89. 

A 
A 

*  Ci  :  interior  (high)  cost 

*  Ce  :  exterior  (low)  cost  pt  C 

*  Alpha  :  included  angle  of  \ 

*  region  vertex  \ 

*  Beta  :  angle  between  first  \        High-Cost  Area 

*  edge  (pt  V  to  pt  A)  and  \        Interior,  cost  =  Ci 

*  a  line  between  the  \ 

*  vertex  and  the  goal .  \ 

*  Gamma  :  angle  between  second  \ 

*  edge  (pt  V  to  pt  C)  and  \ 

*  a  line  between  the  \ 

*  vertex  and  the  goal.  \Alpha 
Dl  :  distance  from  goal  to  vertex.             Gamma    \ 


A 


RotAngle  :  angle  needed  to  rotate  pt  V  pt  A 

the  -X-axis  counterclockwise  /  Beta 

*  to  bring  it  parallel  with 

*  the  first  edge  (V  to  A)  /  Exterior, 

*  Xa,Ya  :  coords  of  first  point.  .  cost  =  Ce 

*  Xv,Yv  :  coords  of  second  point,  / 

*  the  vertex,  connected  to  pt  A  + 

*  Xc,Yc  :  coords  of  third  point.  Goal 

*  Xv2,Yv2  :  if  the  edges  are  not 

*  connected,  these  are  the        Here  the  rotation  angle  =  0. 

*  coords  of  the  "inner"  vertex 

*  of  the  second  edge,  of  which 

*  pt  C  is  the  other  vertex. 
*/ 

plot_2vi3_bdry (Ci, Ce, Xa, Ya, Nab, Xb, Yb,Xc, Yc, Ned, Xd, Yd)   :- 

virtual_vertex  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Xvv,  Yw)  , 

plot_2vis_bdry_allcase3  (Ci,Ce,  Nab,  Ncd,Xa,  Ya,  Xvv,  Yw,  Xd,  Yd)  ,   !  . 
plot_2vig_bdry_al leases (Ci , Ce, Nl, N2, Xa, Ya, Xv,  Yv,  Xc,  Yc)   :- 

initialize_f or_bl ,  /*  This  is  a  2v/  or  */ 

goal_point (Xg, Yg) ,  /*  Type  1  boundary.  ♦/ 

pi(Pi), 

distance (Xv, Yv, Xg, Yg,Dl) , 

distance  (Xv, Yv, Xc, Yc, D2)  , 

distance (Xa, Ya, Xv, Yv, D3 ) , 

distance  (Xa,Ya,Xc,Yc,D4)  , 

distance  (Xa, Ya, Xg, Yg, D5)  , 

not (D1  =  0)  , not  (D2=0)  , not  (D3  =  0)  ,  /*  If  any  of  these  fail,*/ 

not  (D-J-O)  ,  not  (D5  =  0)  ,  /*  =>  programming  error  or  map  error  */ 

Cosl  is  (D2-^2HD3-"2-D4'-2)  /  (2*D2*D3)  , 

arccos (Cosl , Alpha) , 

Cos2  is  (D1^2^D3^2-D5'■2)  /  (2*D1*D3)  , 

arccos (Cos2, Beta) , 

Gamma  is  2*Pi  -  Alptia  -  Beta, 
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ThetaCrit  is  a3in(Ce/Ci), 

tell (user),  write  ('2vis  (Type  1)  bdry  being  plotted  between  edges  ')/ 

write (Nl) , write  ('  and  '), write  (N2) , nl, 

check_input_f or_typel (Alpha, Beta, Gamma, ThetaCrit, Dl) , 

compute_angle_of_rotation (Xv,  Yv,  Xa,  Ya,  RotAngle)  , 

assert (bdry  (  (Xv, Yv] )  )  , 

calc_bdry_typel (Alpha, Beta, Gamma, ThetaCrit, Dl, Xa, Ya, Xv, Yv, Xc, Yc) , 

rotate_bdry (RotAngle) , 

bdry (Bdry) , 

reverse_path_list (Bdry, RevBdry) , 

t runcate_of f_map (RevBdry, FinalBdry) , 

assert  (initbdry ( (Nl , N2 ) , FinalBdry) )  , 

/*  tell (bdry_out) ,  write  ('  Type  1  '),nl, 

write_to_bdry_file (bdry, Bdry,Nl, N2) , nl, 

output_to_f igure_f ile,  */ 

plot_2vis_bdry_allcases (_,_,_,_,_,_,_,  _)  :-   !. 

init  iali7.e_f  or_bl  :- 

abolish (done, 0) , 
abolish (bdry, 1) , 
abolish  (thetal, 1) ,  !  . 

calc_bdry_typel (A, B, G, Tc, Dl , Xa, Ya, Xv, Yv, Xc, Yc)  :- 

ri(Pi), 

get_Tl_range (G, Xv, Yv, Xc, Yc,  Tlmin,  Tlmax)  , 
precision (Precision) , 

DelTl  is  (Tlmax-Tlmin) / (Precision/2)  , 

Tlinit  is  Tlmin  -  DelTl/2,    /*  let  1st  point  be  closer  to  vertex  */ 
assert  (thetal (Tlinit) ) , 
retract  (thetal  (Tlprev)  )  , 
Tl  is  Tlprev  +  DelTl, 
Tl  <  Tlmax+0.01, 
Tl  <  Pi/2, 
assert (thetal (Tl) ) , 

calc_bdryl_pt  (Dl,Tl,A,B,G,Tc,T3,T'l,Yl,Y2), 
store_2vis_result3 (-T3 , -T4 , Yl ,  Y2, B,  Dl ,  Xv,  Yv)  , 
done,  ! . 
calcbdrytypel (_,_,_,_,_,_,_,_,_,_,_)  :-  !. 

calc_bdryl_pt (Dl,Tl,A,B,G,Tc, 

T3,T4,Y1,Y2)   :- 
abol  isli  (donel,  0)  , 
aboli3h(theta3,l), 
abolish (increment, 1) , 
pi  (Pi)  , 

Initlncr  is  -(Pi-B)/2,  /*  1/2  of  range  of  Theta3  */ 

assert (increment  (Initlncr)  )  , 
T3init  is  B-  (Pi/2)  , 
assert (theta3 (T3init) ) , 
retract  (theta3  (T3) ) , 

calc_Epsilon (Dl,Tl,A,P,G,Tc,T3,T4,Yl,Y2,E), 
get_di  rection(E,Dir'>ct:oii)  , 
get _T3 new (Direction, T3,T3new, Incr) , 
assert  (theta3  (T3iiew)  )  , 
donel ,  ! . 

virtual_vertex  (XI,  Yl,  X2,  Y2,  X3,  Y3,  X4,  Y-J,  Xv,  Yv)  :-     /*  the  virtual  vertex  is  */ 
line_intersection (XI, Yl, X2, Y2,X3, Y3, X4, Y4, Xv, Yv) , I .   /*  the  point  of  */ 

/*  intersection  of  the  lines.  */ 

get_Tl  range  (G,  Xv,  Yv,  Xc,  Yr',  Tl  in i  t:  ,  Tl  final)   :  - 
pi  (Pi)  , 
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Tlinit  is  G-Pi/2, 

goal_poii)t  (Xg,  Yg)  , 

distance (Xg, Yg, Xv, Yv, Dl ) , 

distance  (Xc, Yc, Xv, Yv, D2)  , 

distance  (Xg, Yg, Xc, Yc, D3 ) , 

Cos  is  (D2''2  +  D3'-2-Dl"2)  /  (2*D2*D3)  , 

a r ceo 3 (Cos,  Angle) , 

getTlfinal (Angle, Tlfinal) ,  !. 

get_Tl final (Angle, Tlfinal)  :- 

Angle  >  0.05, 

pi  (Fi)  , 

Tlfinal  is  Pi/2  -  Angle,  !. 
get_Tlfinal (Angle, Tlfinal)  :-  /*  Make  Thetal  a  little  larger  */ 

Angle  =<  0.05, 

pi  (Pi), 

Tlfinal  is  ((Pi/2  -  Angle)  +  (Pi/2)  ) /2,  !. 

get_direction (E, minus)  :- 

E  >  0.001, ! . 
get_direction (E, plus)  :- 

E  <  -0.001, ! . 
get_direct ion (E, done)  :- 

assert  (donel ) ,  !  . 

get_T3new (done, _, _, _)  :-  !. 

get_T3new (plus, T3, T3new, Incr)  :- 
increment  (Incr) , 

Incr  <  0,  /*  If  direction  of  search  */ 

T3new  is  T3-Incr,  /*  has  changed,  halve  the  */ 

Halflncr  is  -Incr/2,  /*  incr  6  cliange  signs,    */ 

retract ( increment ()),  /*otherwi3e  don' t .         */ 

assert  (increment (Halflncr) ) ,   !  . 

get_T3new (plus, T3, T3new, Incr )   :- 
retract (increment (Incr) ) , 
T3new  is  T3+Incr, 
assert (increment (Incr) ) ,  ! . 

get_T3new (minus, T3,T3new,  Incr) 

increment  ( Incr ) ,  /*  If  direction  of  search  */ 

Incr  >  0,  /*  has  changed,  halve  the  */ 

T3new  is  T3-Incr,  /*  incr  6  change  signs,    */ 

Halflncr  is  -Incr/2,  /*  otherwise  don't.        */ 

retract (increment (_) ) , 
assert (increment (Halflncr) ) ,  ! . 

get_T3new (minus,  T3  ,  T3new,  Incr)  :- 
retract  (increment  (Incr)  ) , 
T3new  is  T34Incr, 
assert  (increment  (Incr)  )  ,  !  . 

calc_Epsilon (Dl,Tl,A,B,G,Tc,T3,T4,Yl,Y2,E)   :- 
T2  is  asin (sin (Tc) *sin (Tl ) ) , 
T4  is  asin (sin  (Tc) *sin (T3)  )  , 
SinTc  is  sin (Tc) , 
XI  is  Dl*sin (G) /cos (Tl) , 
Yl  is  Dl*sin  (B)  /cos  (T3)  , 
Al  is  Dl*sin (A) /cos (T2) , 
A2  is  Dl*sin (A) /cos (T4) , 
Bl  is  cos (Tl-G) /cos (Tl) , 
B2  is  cos (T2+A) /cos (T2) , 
B3  is  cos (T3-B) /cos (T3) , 
B4  is  cos (T44A) /cos (T4) , 
X2  is  Al*  (B3-B1*B4)  /  (1-B2*B4)  , 
Y2  is  A2*B1- (X2*cos (T24A) /cos (T4)  )  , 
Lhp  is  SinTc*Xl  H  X?, 
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Rhs  is  SinTc*Yl  +  Y2, 
E  is  Lhs-Rlis,   !  . 


/*  E  >  0   if   Cost  (X-path)  >  Cost (Y-path)  */ 


check_input_f or_typel (A,B,G,Tc,Dl)  :- 

pi  (Pi) , 

A  >  0,  A  <  Pi, 

B  >  Pi-A,  B  <  Pi, 

G  >  Pi-A,  G  <  Fi, 

Tc  >  0, 

Tc  <  Pi/2, 

Dl  >  0,  !  . 
check_input_f or_typel (Alpha, Beta, Gamma, Thetacrit, Dl)  : - 

convert_rads_to_degr  (Alpha,  AlpliaUeg)  , 

convert_radsto_degr (Beta, BetaDeg)  , 

convert  rads_to_degr (Gamma, GammaDeg)  , 

convert_rads_to_degr (Thetacrit,  ThetacritDeg)  , 

tell  (user) , 

write  ('  ERROR  in  type  1  input:   A=' ) , 

write (AlphaDeg) , 

write  ('   B-' ) , 

write  (BetaDeg) , 

write  ('   G=' )  , 

write (GammaDeg) , 

writeC   Dl  =  '  )  , 

write (ThetacritDeg) , 

write  (Dl) , nl, 

fail,   !. 


/ 


**A*******A***********A********A*A***A**A********************************** 


*  This  predic.  draws  Ivis  (Type  2)  boundaries,  ie,  boundaries  between 

*  one  visible  and  one  hidden  HCA  edge. 

A 

*  Updated  31  Jan  89 

*  "plot  lvis_bdry"  draws  a  boundary  for  edge  1  visible  and  edge  2  hidden; 

*  "plotbdry2  inv"  draws  a  boundary  for  edge  2  visible  and  edge  1  hidden; 


*  Ci  :  interior  (high)  cost 

*  Ce  :  exterior  (low)  cost 

*  Alpha  :  included  angle  between 

*  the  two  edges . 

*  Beta  :  angle  between  first 

*  edge  (pt  V  to  pt  A)  and 

*  a  line  between  the 

*  vertex  and  the  goal. 

*  XI  :  distance  from  goal  to  vertex. 

*  Angle  :  angle  needed  to  rotate 

*  the  X-axis  counterclockwise 

*  to  bring  it  parallel  with 

*  the  first  edge  (V  to  A) 

*  Xv,Yv  :  coords  of  second  point, 

*  t  he  vertex . 


pt  D 
/ 
/    High-Cost  Area 
pt  PI  /   Interior,  cost  ==  Ci 


/ 


/ 
/ 
pt  C  \ 


\ 


Alpha 
Gamma 


pt  B  \ 


Beta 


\ 

+ 
Goal 


pt  A 


Exterior, 
cost  =  Ce 


'/ 


Here  the  rotation  angle  =  0 


plot_lvis_bdry (o,Ci,Ce,Xa, Ya,Nab,Xb, Yb,Xc,  Yc,  tied,  Xd,  Yd)  :-   /*  Opposite  edge.  */ 
not (opposi t e_point (Xc,Yc) ) , 

pseudo_optimal_path ( (Xc, Yc lore  1 ) ,         /*  Ist-pass,  no  shortcutting  */ 
counterclockwise ( (Xc, Yc lOFc] ) ,  /*  If  before  opposite  point.*/ 
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tell (user) , 

write ('Iv/b  (Type  2)  bdry  being  plotted  between  edges  '), 

wr ite (Hab)  , write  ('  and  '),  write (Ned) , nl, 

goalpoint  (Xg, Yg)  ,  /*  Iv/-  (Type  2)  bdry  */ 

translateline (Xb,  Yb, Xc, Yc, Xd, Yd.Xdtr, Ydtr) , 

path_length ( (Xc, Yc | OPc ] , Dl ) , 

distance (Xb, Yb, Xc, Yc, D2calc) , 

add_ep9ilon_if_zero (D2calc,  D2) , 

distance  (Xb, Yb, Xg, Yg, D3 )  , 

distance (Xc, Yc, Xd, Yd,Dcd)  , 

distance (Xa, Ya, Xb, Yb,Dab) , 

distance (Xa, Ya, Xg, Yg, Uag) , 

di  stance (Xa,  Ya, Xdtr, Ydtr, Dadtr) , 

distance (Xa,  Ya,  Xc,  Yc,  Dca)  , 

Cosl  is  (Dcd'2+Dab"2-Dadtr"2) / (2*Dcd*Dab) , 

arccos  (Cosl,AlpliaAbs)  , 

3ign_of_Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Alpha) , 

Cos2  is  (D3'2  +  Dab-"2-Dag"2)  /  (2*D3*Dab)  , 

arccos (Cos2, Bet  a ) , 

Cos3  is  (D2"2fDab'2-Dca'2) / (2*D2*Dab) , 

arccos (Cos 3, Gamma) , 

compute_angle_of_rotation (Xd, Yd, Xc, Yc, RotA) , 

connected (Xa, Ya,Xb, Yb,Xc, Yc, Xd, Yd,  Conn)  , 

plot_lvis_bdry2 (before, Conn,  Ci,  Ce,  Nab,  Ned, 

Alpha, Beta, Gamma, Dl , D2, D3, 

Dag, Dab, Xc, Yc, RotA) ,  '. 

plot_lvis_bdry (o, Ci,Ce, Xa, Ya,Nab, Xb, Yb,Xc,  Yc,Ncd,Xd,  Yd)  :-    /*  opposite  edge  */ 
pseudo_opt imal_path ( (Xd, Yd lOPd] )  ,  /*  Must  be  after  opp  pt  */ 

tell  (user) , 

write  ('Iv/a  (Type  2)  bdry  being  plotted  between  edges  '), 
write  (Nab)  , write ( '  and  '), write (Ned)  , nl , 

goal_point (Xg, Yg) ,  /*  Iv/-  (Type  2)  bdry  */ 

tran9late_line (Xa, Ya, Xd, Yd, Xc, Yc,Xctr,  Yctr)  , 
path_length ( [Xd, Yd|OFd] ,D1)  , 
distance  (Xa, Ya, Xd, Yd, D2calc) , 
add_epsilon  if  zero  (D2calc, 02) , 
distance (Xa, Ya, Xg, Yg, D3 ) , 
distance (Xc,Yc,Xd,Yd,Dcd) , 
distance (Xa, Ya, Xb, Yb, Dab) , 
distance (Xb,  Yb,  Xg,  Yg,  Dbg)  , 
distance (Xb, Yb, Xct r , Yctr , Dbctr) , 
distance (Xb, Yb, Xd, Yd,  Ddb)  , 

Cosl  is  (Dcd'^2  +  Dab^2-Dbctr^2)  /  (2*Dcd*Dab)  , 
arccos (Cosl, AlphaAbs) , 

sign_of_Alpha (AlphaAbs, Xb, Yb, Xa , Ya , Xd, Yd,  Xc,  Yc,  Alpha)  , 
Cos2  is  (D3''24Dab'2-Dbg"2)  /  (2*D3*Dab)  , 
arccos (Cos2, Beta) , 

Cos3  is  (D2'-24Dab'-2-Ddb"2)  /  (2*D2*Dab)  , 
arccos (Cos3, Gamma) , 

compute_angle_of_rotat  ion(Xd,Yd,Xc,Yc,  RotA)  , 
connected (Xa, Ya, Xb, Yb, Xc,  Yc, Xd, Yd,  Conn)  , 

plot_lvis_bdry2 (after, Conn, Ci,Ce, Nab, Ned, Alpha, Beta, Gamma, 
Dl, D2,D3, Dbg, Dab, Xd, Yd, RotA) , ! . 

plot_lvis_bdry (b, Ci, Ce, Xa, Ya, Nab, Xb, Yb,Xc, Yc, Ned, Xd, Yd)   :-  /*  before  opp  edge  */ 
optimalpath ( |Xd,Yd,c(C) ,Xpl,Ypl|F]) , 
counterclockwise ((Xd,Yd,c(C) ,Xpl,Ypl|F) ) , 

tel 1 (user ) ,  write ('Iv/b  (Type  2)  bdry  being  plotted  between  edges  '), 
write  (Nab)  , write  ( '  and  '), write  (Ned) , nl, 

goal_point  (Xg, Yg)  ,  /*  Iv/-  (Type  2)  bdry  */ 

translate_line (Xb,Yb,Xc,Yc,Xd,Yd, Xdtr, Ydtr) , 
distance (Xd,  Yd, Xpl , Ypl, Ddp)  , 
assert _stiortcut  flag(Xc,Yc,Xpl,Ypl)  , 
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patli_lengtli(  [Xpl,ypl  |P]  ,D1)  , 

distance (Xb,  Yb, Xpl , Ypl , D2calc) , 

add_epsilon_if _zero (D2calc,D2), 

distance (Xb, Yb,Xg, Yg,D3) , 

distance (Xc,  Yc, Xd, Yd, Dcd) , 

distance (Xa,  Ya, Xb, Yb, Dab) , 

distance (Xa,Ya,Xg,Yg, Dag), 

distance (Xa,  Ya,  Xdtr, Ydtr, Dadtr) , 

distance (Xa,  Ya, Xpl , Ypl, Dpla) , 

Cosl  is  (Dcd^2+Dab^2-Dadtr^2) / (2*Dcd*Dab) , 

arccos (Cosl , AlphaAbs) , 

signof  Alpha (AlphaAbs, Xa, Ya, Xb, Yb,Xc,yc,Xd, Yd, Alpha) , 

Cos2  is  (D3'2+Dab'2-Dag^2) / (2*D3*Dab) , 

arccos (Cos 2, Beta) , 

CosB  is  (D2'2  +  Dab-' 2-Dpla-^2)  /  (2*D2*Dab)  , 

arccos  (CosB,  Gamitia)  , 

conipute_angle_of_rotation  (Xd,  Yd,  Xc,  Yc,  RotA)  , 

connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd,  Yd,  Conn)  , 

/*    changed    Xc,Yc    for    Xpl, Ypl    */ 
plot_lvis_bdry2 (before, Conn, Ci,Ce, Nab, Ned, Alpha, Beta, Garrana, 

Dl,D2,D3,Dag,  Dab, Xpl, Ypl, RotA) ,  !  . 

plot_lvis_bdry (a,Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc,Ncd,Xd, Yd)  :-   /*  after  opp  edge  */ 

optimal_path ( (Xc,  Yc,  c(C)  ,  Xpl,  Ypl  IP)  )  , 

cloc)cwise  (  [Xc,  Yc,  c  (C)  ,  Xpl,  Ypl  I  P)  )  ,  /*  discriminates  btwn  OP  '  s  */ 

/*  in  opposite  directions  from  opp  pt .  */ 

tell (user),  write ('Iv/a  (Type  2)  bdry  being  plotted  between  edges  '), 

write (Nab) , write  ( '  and  '), write (Ned) , nl , 

goal_point (Xg, Yg) ,  /*  Iv/-  (Type  2)  bdry  */ 

translateline (Xa, Ya, Xd, Yd, Xc, Yc,  Xctr,  Yctr)  , 

distance(Xc,Yc,Xpl,ypl,Dcp)  , 

assert_shortcut_f lag (Xd, Yd,  Xpl ,  Ypl )  , 

patli_length  ((Xpl,Ypl|P),Dl), 

distance (Xa, Ya, Xpl , Ypl , D2calc) , 

add_epsilon_if_zero (D2calc, D2) , 

distance (Xa,Ya,Xg,Yg,D3) , 

distance (Xc, Yc, Xd, Yd, Dcd) , 

distance(Xa,Ya,Xb,Yb,Dab) , 

distance (Xb, Yb, Xg, Yg, Dbg) , 

distance (Xb, Yb, Xctr, Yctr, Dbctr) , 

distance (Xb, Yb, Xpl , Ypl , Dplb) , 

Cosl  is  (Dcd"2+Dab"2-Dbctr"2) / (2*Dcd*Dab) , 

arccos (Cosl, AlphaAbs) , 

sign_of_Alpha (AlphaAbs, Xb, Yb, Xa, Ya , Xd, Yd, Xc, Yc, Alpha) , 

Cos2  is  (D3'2  +  Dab"2-Dbg'2) / (2*D3*Dab)  , 

arccos (Cos2,  Beta)  , 

CosB  is  (D2'-24Dab'-2-Dplb'-2)  /  (2*D2*Dab)  , 

arccos (CosB, Gamma) , 

compute_angle_of_rotat ion  (Xd, Yd, Xc, Yc, RotA)  , 

connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd,  Conn)  , 

/*  changed  Xd, Yd  for  Xpl, Ypl  (why  Xd,Yd???)  */ 

plot_l vis_bdry2 (after, Conn, Ci , Ce, Nab, Ned, Alpha, Beta, Gamma, 
D1,D2, D3, Dbg, Dab, Xpl, Ypl, RotA) , ! . 
/*  plot_lvi9_bdry (_,_,_,_,_,_,_,_,_,_,_,_,_)  :-   !.  */ 

plot_lvi9_bdry2 (before, Conn, Ci,Ce,Nl,N2,A,B,G,Dl,D2,D3,Dag, Dab, Vx, Vy, Rot Angle) : - 
abol i  sh  (bdry,  1 ) , 
aboli  ah (donp,  0)  , 
abolish  (thetal, 1) , 

calc_lvis_hdry (Ci, Ce, A, B, G, Dl , D2, D3, Dag, Dab, Vx, Vy ) , 
rotate_bdry (PotAngle) , 

remove_last_bdry_eoord_i  f_di  sconnected(Conn) , 
bdry (Bdry) , 
reverse  patli  list  (Bdry ,  RevBdry)  , 
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t runcate_of f _map (RevBdry, FinalBdry) , 
assett(initbdry(lNl,N2],FinalBdry)), 
/*       tell (bdry_out) , write ('  Type  2  '),nl, 
write_to_bdry_f ile (bdry, Bdry) , 
output_to_f igure_f ile,  */ 
I 

plot_lvis_bdry2 (after, Conn, Ci,Ce,Nl,N2,A,B,G,Dl,D2,D3, Dbg, Dab, Vx, Vy, Rot Angle) 

abol i  sh (bdry,  1 )  , 

abolish  (done, 0) , 

abolish  (thetal , 1 ) , 

calc_lvis_bdry (Ci,Ce,A,B,G,Dl,D2, D3,Dbg, Dab, Vx, Vy) , 

invert_bdry , 

rotate_bdry (RotAngle) , 

remove_last_bdry_coord_if_disconnected  (Conn) , 

bdry (Bdry) , 

reverse_path_list (Bdry, RevBdry) , 

t runcate_of f_map (RevBdry, FinalBdry) , 

assert (initbdry ( (HI ,N2] , FinalBdry) ) , 
/*       tell (bdry_out)  , write  ('  Type  2-inv  '),nl, 

write_to_bdry_f ile (bdry, Bdry) , 

output_to_f igure_f ile,  */ 

I 

calc_lvi3_bdry (Ci,Ce,A,B,G,Dl,D2,D3,Dag, Dab, Vx, Vy)  :- 

assert (bdry  (  [Vx, Vy) )  )  , 

niaxX(XMax),  minX  (XMin)  , 

LargeNumber  is  (XMax  -  Xl-1in)*100, 

assert  (sc_bdry_pt_dist (LargeNumber) )  , 

CostRatio  is  Ce/Ci, 

Tc  is  asin (CostRatio) , 

get_tlmin(Dag,Dab,D3,Tlmin) , 

get_tlmax (B, Tlmax) , 

precision  (Precision) , 

DelTl  is  (Tlmax-Tlmin) /Precision, 

Tlinit  is  Tlmax  +  DelTl, 

assert  (tlnetal  (Tlinit)  )  , 

retract (thetal  (Tlprev) ) , 

Tl  is  Tlprev  -  DelTl, 

Tl  >=  Tlmin, 

assert (thetal (Tl) )  , 

calc_lvis_bdry_pt (Tc,A,B,G,Dl,D2,D3,Tl,Xl,X2)  , 

s t or e_lvis_re suits (XI , X2, Tc, Vx, Vy) ,  fail . 
calc_lvis_bdry (_,_,_,_,_,_,_,_,_,_, _,_)  :- 

abolish (sc_bdry_pt_dist , 1) ,  !. 

get_t Imin (Dag, Dab, D3, Tlmin)  : - 

pi(Pi), 

Cosl  is  (Dag''24Dab'-2-D3"2)  /  (2*Dag*Dab)  , 

arccos (Cosl , Tlminplus90) , 

Tlmin  is  Tlminplus90  -  Pi/2,   !  . 
get_t Imax (B, Tlmax)    :- 

pi  (Pi)  , 

NinetyminusB  is  Pi/2  -  B, 

Tlmax  is  Ninet yminusB,   ! . 

calc_lvis_bdry_pt (Tc,A,B,G,Dl,D2,D3,Tl,Xl,X2)   :- 
T2  is  asin (sin (Tl) *sin (Tc) ) , 
TlplusB  is  Tl  +  B, 
TcplusAminusT2  is  Tc  +  A  -  T2, 
T2minusA  is  T2  -  A, 
T2minusG  is  T2  -  G, 
Fl  is  sin(A)  -  cos  (T2 )  *  sin (Tc)  , 
X2  is  (-D1 'sin  (Tc)  *cos  (T2)  *cos  (T2niinusA) 

4D2* (cos (T2minusA) *sin(G)-cos (T2minusG) *F1) 
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+D3* (COS (T2) /cos (Tl) ) * 

(sin  (B)  *3in (Tc) *cos (T2minu9A) +co9 (TlplusB)  *F1) ) 
/ (sin (TcplusAminusT2) *F1 

+COS (T2minusA) * (cos (Tc+A) +cos (T2) ) ) , 
XI  is  -X2*  (sin  (TcplusAiT\inusT2) /cos  (T2minusA)  ) 
-D2*  (cos  (T2niinusG)  /cos  (T2niinusA)  ) 
+  D3*  (cos  (T2)  *cos (TlplusB) / (cos (Tl) *cos (T2minusA) )  )  ,  !  . 

translate_line  (Xref,Yref, XI, Y1,X2,Y2,X2 trans, Y2trans)  :- 
DelX  is  Xl-Xref, 
DelY  is  Yl-Yref, 
X2trans  is  X2  -  DelX, 
Y2trans  is  Y2  -  DelY,   !  . 

next_to_last_pt (lX,Y,Xlast,Ylast), [X,Y)) . 
next_to_last_pt ((Xl,Yl|RJ,[X,YJ)  :- 
next_to_last_pt  (P,  [X, Y) )  ,  !. 

store_lvis_results (XI , X2  ,  Tc,  Vx,  Vy )  :- 
not  (shortcut  (_/_/ Vx,Vy)  )  , 
Xbdry  is  Vx  -  XI  -  X2*3in(Tc), 
Ybdry  is  Vy  +  X2*cos(Tc), 
retract (bdry (BList)  )  , 
assert  (bdry( [Xbdry, Ybdry IBList]  )  )  ,  !  . 

store_lvis_results (XI, X2, Tc, Vx, Vy)  :-  /*  The  effect  of  rules  2  5  3   */ 

shortcut (_,_, Vx, Vy) ,  /*  is  to  exclude  the  initial   */ 

Xbdry  is  Vx  -  XI  -  X2*gin(Tc),  /*  portion  of  a  bdry  which     */ 

Ybdry  is  Vy  +  X2*co3(Tc),  /*  starts  at  a  s/c  pt,  as  long*/ 

distance  (Xbdry,  Ybdry ,  Vx,  Vy,  Dnew)  ,       /*  as  the  bdry  is  coming  back.  */ 
sc_bdry_pt_dist  (Dold) ,  /*  toward  the  s/c  pt ,  and      */ 

Dnew  >=  Dold,  /*  include  the  later  portion   */ 

ret ract (sc_bdry_pt_dist (Dold) ) ,         /*  as  it  goes  away  from  it,    */ 
assert (sc_bdry_pt_dist (Dnew) ) ,  /*  since  thetamax  is  calculated*/ 

retract (bdry (BList )) ,  /*  for  the  non-s/c  case  and  is*/ 

assert (bdry ( [Xbdry, Ybdry I BList ])) ,  !.  /*  too  large  for  the  s/c  case.*/ 

store_lvis_results (X1,X2, Tc, Vx, Vy)  :- 
shortcut  (_,_,Vx,Vy)  , 
Xbdry  is  Vx  -  XI  -  X2*sin(Tc), 
Ybdry  is  Vy  +  X2*co3 (Tc) , 
distance (Xbdry, Ybdry, Vx, Vy, Dnew) , 
retract  ( sc_bdry_pt_dist  (Dold)  )  , 
Dnew  <  Dold, 
assert (sc_bdry_pt_dist (Dnew) ) ,  ! . 

/*  If  edge  AB  is  parallel  to  CD,  AlphaAbs  will  be  0,  so  Alpha  is  0.  */ 
3ign_of_Alpha (0, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, 0)  . 

/*  If  AB  intersects  CD  on  the  B-side  of  AB,  Alpha  is  positive.  */ 
sign_of_Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd,  AlphaAbs)  : - 

line_inter sect ion (Xa,Ya,Xb,Yb,Xc,Yc,Xd,Yd,Xi,Yi), 

distance (Xi,Yi,Xa,Ya,Dia)  , 

distance (Xi, Yi, Xb,  Yb,  Dib)  , 

Dia  >=  Dib. 
/*  Otherwise,  AB  intersects  CD  on  tlie  A-side  of  AB  and  Alp)ia  is  negative.  */ 
sign_of_Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc,  Yc, Xd,  Yd,  -AlphaAbs)  . 

/*  If  X  =  0,  return  a  sligtitly  positive  value,  else  leave  X  unchanged  */ 
add_ep3ilon_if_zero  (0, 0  .0001)  . 
add_ep3ilon_if_zero (X, X) . 

/*  returns  Conn  =  conn  if  tlie  two  line  segments  are  connected,  */ 
/*  and  Conn  =  disc  otherwise.   */ 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xa, Ya, conn) . 
connected (Xa, Ya, Xb, Yb, Xb, Yb, Xd, Yd, conn) . 
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connected (Xa,  Ya ,  Xh,  Yb, Xa, Ya, Xd, Yd, conn)  . 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xb, Yb, conn) . 
connected (Xa, Ya, Xb, Yb,  Xc,  Yc,  Xd,  Yd,  disc)  . 

/*  If  the  two  edges  are  not  connected,  the  first  point  in  the  */ 
/*  Bdry  list  is  not  part  of  the  boundary,  but  only  there  to  */ 
/*  specify  the  point  about  whicli  to  rotate.  */ 
remove_last_bdry_coord_if_disconnected (conn) . 
remove_last_bdr y_coord_if _di3connected (disc)  :  - 

retract (bdry (Bdry) ) , 

rever 3e_path_li  st(Bdry,  (X,Y1 Re versed Bdry)), 

rever3e_path_list (Rever sedBdry, RevisedBdry) , 

assert (bdry (RevisedBdry) ) . 

* 

*  riot  Ovis  boundaries,  between  two  hidden  edges. 

*  Updated  12  Jan  89. 

*/ 

plot_Ovis_bdry (b, b,  Ci , Ce, Xa,  Ya,Nab,  Xb, Yb,Xc, Yc,Ncd,Xd, Yd)  :- 

tell (user),  /*  'before'  compared  with  'before'  */ 

wr i te  ( ' Ov/M (b)   (Type  3)  bdry  being  plotted  between  edges  '), 

write (Nab)  , writ e  ( '  and  '), write  (Ned) , nl, 

abolish (bdry,  1)  , 

optimal_path ( | Xd, Yd, c (Ca)  ,  Xpl , Ypl | OPpl ] )  , 

counterclockwise ((Xd,Yd,c(Ca),Xpl,Ypl|OFpl)), 

pathlength ( [Xpl, Ypl lOPpl]  ,Dplg)  , 

optinial_path  (  [Xb,  Yb,  c  (Cb)  ,  Xp3,  Yp3  |OPp3]  )  , 

path_lenqth ([Xp3,Yp3|Orp3),Dl), 

D2  is  Dplg  -  Dl, 

di  stance (Xa, Y a, Xb,Yb, Dab)  , 

distance (Xa, Ya, Xpl , Ypl , D3) , 

distance (Xb,  Yb, Xpl , Ypl, Dbpl ) , 

distance (Xd,  Yd, Xpl, Ypl, Ddpl) , 

distance(Xa,Ya,Xd,Yd,Dad) , 

distance (Xc, Yc, Xd, Yd, Dcd) , 

distance(Xp3,Yp3,Xa,Ya, Z) , 

pi(Pi), 

Cosl  is  (D3"24Dab'2-Dbpl-"2)  /  (2*D3*Dab)  , 

arccos (Cosl, A) , 

Cos2  is  (Ddpl"24D3-^2-Dad"2)  /  (2*Ddpl*D3)  , 

arccos  (Cos2,Pin\inu3Beta)  , 

B  is  Pi  -  FiminusBeta, 

Tc  is  asin (Ce/Ci) , 

compute_angle_of _rotation (Xd,Yd,Xc,Yc,  Rot Angle )  , 

calcbdryptOvisM (A, B, Tc, Xpl , Ypl , Z, Dl , D2, D3, 0, X2bdry , Y2bdry ) , 

calc_bdry_pt_OvisM(A, B, Tc, Xpl , Ypl , Z , Dl , D2, D3 , Dcd, XI bdry, Ylbdry) , 

abolish (bdry,  1)  , 

assert  (bdry ((Xlbdry, Ylbdry, X2bdry, Y2bdry,  Xpl,  Ypl]  )  )  , 

rotate2_bdry  (RotAnql<=)  , 

bdry ( [xT, Y1,X2, Y2] ) , 

correct_error_in_coiui_edqes (Xb, Yb, Xc, Yc, Xpl , Ypl , X2, Y2 , X2r , Y2r ) , 

a3sert(initbdry([Nab,NcdJ,  (X2r,Y2r,Xl,Yl])),      !  . 

plot_0vi3_bdry ( a , a , Ci , Ce , Xa , Ya,  Nab,  Xb,  Yb, Xc,  Yc,  Ned,  Xd,  Yd)      :  - 

tell(user),  /*    'after'     compared    with    'after'     */ 

wr ite ( ' Ov/M (a)      (Type    3)     bdry    being    plotted    between    edges    '), 

writ e  (Nab)  , write  ( '     and    '), writ e  (Ned)  , nl , 

abo]  i  sin  (bdry,  1 )  , 

optimalpath ( [Xc, Yc, c (Cc)  ,  Xp3 ,  Yp3 |OPp3] )  , 

path_length ( (Xp3, Yp3 |OPp3) ,  tU)  , 
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optimalpath ( [Xa, Ya, c (C) , Xpl , Ypl lOPpl ] ) , 

clockwise ( 1 Xa, Ya, c (C) , Xpl , Ypl t orpl ] ) , 

path_lenath ( ( Xpl , Ypl I OPpl ) , Dplg) , 

D2  is  Dplg  -  Dl, 

distance  (Xa, Ya, Xb, Yb,Dab) , 

distance(Xd, Yd,Xpl, Ypl,D3) , 

distance  (Xa, Ya, Xpl , Ypl , Dapl)  , 

distance  (Xc, Yc, Xpl, Ypl, Dcpl) , 

distance  (Xa, Ya, Xd, Yd, Dad) , 

distance  (Xa, Ya, Xb, Yb,Dab) , 

distance (Xc, Yc, Xd, Yd, Dcd) , 

distance  (Xp3, Yp3, Xd, Yd, Z) , 

pi  (Pi) , 

Cosl  is  (D3"2  +  Dcd-^2-Dcpl'-2)  /  (2*D3*Dcd)  , 

arccos (Cosl , A) , 

Cos2  is  (Dapl^2+D3"2-Dad"2) / (2*Dapl*D3) , 

arccos (Cos2, PiminusBeta) , 

B  is  Pi  -  PiminusBeta, 

Tc  is  asin  (Ce/Ci) , 

compute_angle_of_rotat ion (Xb,Yb,Xa,Ya, RotAngle) , 

calc_bdry_pt_OvisM(A, B, Tc, Xpl , Ypl , Z, Dl , D2, D3, 0, Xlbdry , Ylbdry) , 

calc_bdry_pt_OvisM(A, B, Tc, Xpl , Ypl, Z, Dl , D2, D3, Dab,X2bdry, Y2bdry) , 

abolish  (bdry, 1)  , 

assert  (bdry  (  (X2bdry, Y2bdry, Xlbdry , Ylbdry, Xpl, Ypl) ) ) , 

invert_bdry , 

rotate2_bdry (RotAngle) , 

bdry ( ( XI , Yl , X2 , Y2 ) ) , 

cot rect_er ror_in_conn_edges (Xb, Yb, Xc, Yc, Xpl , Ypl ,X2,Y2,X2r,Y2r) , 

assert  (initbdry( (Nab, Hcd] ,[X2r,Y2r,Xl,Yl))),  !. 

plot_Ovis_bdry (b,  a, Ci , Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd)  :- 

tell  (user),  /*  'before'  compared  with  'after'  */ 

write ('Ov/D  (Type  4)  bdry  being  plotted  between  edges  '), 

write (Nab) , write ( '  and  '), write (Ned) , nl, 

abolish (bdry , 1 ) , 

optimal_path  (  [Xb, Yb, c  (CI ) , Xpl , Ypl I OPpl ) ) , 

counterclockwise  (  (Xb, Yb, c  (CI ) , Xpl , Ypl | OPpl ] ) , 

path_length ( [Xpl , Ypl | OPpl ), Dl ) , 

optimal_path( [Xc, Yc,c (C2) , Xp2, Yp2 I OPp2 ] )  , 

clockwise  (  [Xc, Yc, c  (C2) , Xp2, Yp2 |OPp2] ) , 

path_length ( [Xp2, Yp2  iOPp2] , D2) , 

not (same (Dl, D2) ) , 

distance (Xpl, Ypl, Xp2, Yp2, D3) , 

distance (Xc,Yc, Xpl, Ypl, Dcpl) , 

distance (Xc, Yc, Xp2, Yp2, Dcp2) , 

distance (Xb, Yb, Xpl, Ypl,Dbpl) , 

distance  (Xb, Yb, Xp2, Yp2,Dbp2)  , 

pi  (Fi)  , 

Cosl  is  (D3"2+Dcp2^2-Dcpl"2) / (2*D3*Dcp2) , 

arccos (Cosl,Piover2plusAlpha) , 

A  is  P iover 2plusAlpha  -  (Fi/2), 

Cos2  is  (D3"2  +  Dbpl'2-Dbp2"2) /  (2*D3*Dbpl)  , 

arccos (Cos2, Piover2plusBeta )  , 

B  is  Fiover 2plusBeta  -  (Pi/2) , 

Tc  is  asin (Ce/Ci) , 

compute_angle_of  rotaf  ion  (Xa, Ya, Xb, Yb,  RotAngle)  , 

calc_bdry_pt_OvisD (A,B,Tc,Xpl,Ypl,Dl,D2,D3,6,X2bdry,Y2bdry), 

calc_bdry_pt_OvisD (A,B,Tc,Xpl,Ypl,Dl,D2,D3,  Dbpl,  Xlbdry ,  Ylbdry )  , 

abolish (bdry, 1 ) , 

assert  (bdry ( [Xlbdry, Ylbdry , X2bdry , Y2bdry,  Xpl,  Ypl] )  )  , 

invert  bdry, 

rotate2_bdry (RotAngle)  , 

bdry  (  [X1,Y1,X2,Y2])  , 

correct_error_in_opp_edge (Xb, Yb, Xc, Yc,  XI ,  Yl ,  XI r  ,  Yl i )  , 
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assert  (initbdry  (  [Nab, Ned] ,  [Xl r , Ylr , X2, Y2 ] )  )  ,  !  . 

plot_Ovis_bdry  {_._,  _r  _,_,_,_,  _r  _,_,_>_>_>  _)     '■ - 

tell  (user)  ,  writeC  Bdry  does  not  exist.' ),nl,  !. 

calc_bdry_pt_OvisD (A, B, Tc, Xo, Yo, Dl , D2, D3, XI , X, Y)  :- 
TcplusA  is  Tc  +  A, 

Fl  is  sin(A)  +  cos (TcplusA) *sin (Tc) , 

Tl     is    cos  (Tc)  *  (sill  (B) -sill  (Tc)  *cos  (TcplusA)  )     +    cos  (Tc  t  A+B)  *  Fl , 
T2    is    cos (Tc)     -    sin  (TcplusA) *F1, 
T3    is    cos (TcplusA) *co9 (Tc) *sin (Tc) , 

Denom    is    cos  (TcplusA) *cos  (Tc) +cos (Tc ^B) *cos (Tc) -sin (2* 
X2    is     (X1*T1    +    D3*T2    +     (D2-D1)*T3)     /    Deiioiii, 
X    is    Xo    -     (Xl+X2*sin (Tc)  )  , 


Tc+A+B) *F1, 


Xo  -  (Xl+X2*sin (Tc) ) , 
Y  is  Yo  -  X2*cos (Tc) ,   ! 


calc_bdry_pt_0vi3M (A,B,Tc,Xo,Yo,Z,Dl,D2,D3,Xl,X,Y)  :- 

Tl  is  sin (A+B) +sin (Tc) *co3 (Tc+A  +  B) -cos (Tc) *sin (Tc)  , 

T2  is  D3*  (sin  (A)  tsin  (Tc)  *cos  (Tc  +  A)  )  , 

T3  is  D2*co3 (Tc) *sin (Tc) , 

T-J  is  Z*sin  (Tc)  *cos  (Tc)  , 

T5  is  cos (Tc) -cos (Tc-A-B)  +sin  (Tc)  *sin (A  +  B)  , 

X2  is  (X1*T1  H  T2  -  T3  -  T4)/T5, 

X  is  Xo  -  (XI IX2*sin (Tc) ) , 

Y  is  Yo  +  X2*cos (Tc)  ,  !  . 

/*  If  edg»s  are  connected  then  pt  B  =  pt  C   and  bdry  */ 

/*  should  start  exactly  at  pt  Fl.  */ 

cor  rect_er ror_in_conn_edges (Xb, Yb, Xb, Yb, Xpl, Ypl , _, _, Xpl, Ypl ) 

/*  If  edges  are  not  connected  use  the  */ 

/*  bdry  point  as  calculated.  */ 

cor rect_er ror_in_conn_edges (_,_,_,_,_,_, XI, Yl, XI, Yl)  . 

/*  If  edges  are  part  of  the  opposite  edge,  then  */ 

/*  bdry  should  start  er.actly  at  tlie  opposite  point.  */ 

correct_error_in_opp_edge (Xb,Yb,Xc,Yc,_,_,  Xopp,  Yopp)  : - 

opposite_point_minus (Xb,  Yb)  , 

opposi  te_point_plus (Xc, Yc)  , 

opposite_point (Xopp, Yopp) . 
/*  If  not,  then  leave  start  of  bdry  uncliaiiged.   */ 
cor rect_er ror_in_opp_edge (  ,  ,  ,  ,X,Y,X,Y). 


* 

*  plotoebdry  computes  liCA  Interior  Opposite-Edge  Boundaries  (Type  5) 

*  Assumes  no  short  cut t ing ! 

* 

*  Updated  12  Jan  89. 
*/ 

plotoebdry  (Ci,  Ce,  Xa,  5fa,  Xb,  Yb)  :- 

plotoebdry (Ci,  Ce,  Xa, Ya, Xb, Yb, B)  . 
plotoebdry (Ci,Ce, Xa,Ya, Xb, Yb, Bdry)   :- 

optimalpath ([Xb,Yb|_],Dl), 

optimalpath ( [Xa, Ya |_ ] , D2) , 

distance (Xa, Ya,Xb, Yb, D3) , 

compute_angle_of_rotation (Xb,Yb,Xa,Ya, Rot Angle) , 

plot2oebdry(Ci,Ce,Dl,D2,D3,Xb,Yb, Rot Angle, Bdry) , 

/♦  tell(user),write((Xa,Ya,Xb,Yb)),nl,*/ 

I 
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plot2oebdry (IntCost, ExtCost , Dl , D2, D3, Vx, Vy, Angle, RevBdry)  :- 
initialize_f orS, 
tell(user),  nl,nl, 

/*  write ('HCA  Int  Opp-Edge  (Type  5)  bdry  being  plotted  for  edge  '),  */ 
Tc  is  asin  (ExtCost/IntCost ) , 
calc_oebdry_pt3 (Tc,Dl,D2,D3,Vx,Vy, Angle) , 
rotate_bdry (Angle) , 
retract (bdty(Bdry) ) , 
remove_la3t_pt (Bdry, RevBdry)  , 
truncate_of f_map (RevBdry, FinalBdry) , 
assert  (initbdry (oe, FinalBdiy)  )  , 

/*  tell (bdryout) , write ('  Type  5  ' ) , nl, 

write_to_bdry_f ile (bdry,  RevBdry)  , 
output  to  figure  file,  */ 
!  .     ~   ~       ~ 

calc_oebdry_pts (Tc, Dl, D2,  D3,  Vx,  Vy,  Angle)  :  - 
Xll  is  (D3+D2-D1) /2, 
X22  is  Xll/sin  (Tc) , 
Xa  is  Vx  +  Xll, 
Ya  is  Vy, 

Xb  is  Vx  +  X22*3in(Tc), 
Yb  is  Vy  4  X22*co3(Tc), 
assert  (bdry ( (Xa , Ya , Xb, Yb, Vx, Vy ] )  )  ,   ?  . 

initiali2e_f or 5  :- 

abolish (bdry, 1) ,  ! . 

/*  First  check  whether  bdry  starts  on  the  map.   If  so,  call  trunc..2  */ 
/*  if  not,  call  trunc. .3  */ 
truncate_of f_map ([X1,Y1,X,Y|B),B2)  :- 

minX (MinX) ,minY (MinY) , 

maxX (MaxX) ,maxY (MaxY) , 

DelX  is  MaxX  -  MinX, 

XI  >  MinX,  XI  <  MaxX,  Yl  >  MinY,  Yl  <  MaxY,       /*  starts  ON  the  map.*/ 

truncateof f_map2 ([X1,Y1,X,Y|B),B2),  !. 
truncate_of f_map ( IXl, Yl, X, Y I B] , B2)  :-  /*  starts  OFF  the  map.*/ 

truncate_of f_mar3 ([X1,Y1,X,Y|B],B2),  !. 
truncate_of f_map2 ( (XI, Y1,X, Y| B) , (XI, Yl I B2] )  :-  /*  Assumes  that  Bdry  */ 

minX (MinX) ,minY (MinY) ,  /*  starts  OU    the  map.*/ 

maxX (MaxX) ,maxY (MaxY) , 

DelX  is  MaxX  -  MinX, 

MinX2  is  MinX  -  0.1*De]X, 

MinY2  is  MinY  -  0.1*DelX, 

MaxX2  is  MaxX  +  0.1*DelX, 

MaxY2  is  MaxY  I  0.1* DelX, 

X  >  MinX2,  X  <  MaxX2,  Y  >  MinY2,  Y  <  MaxY2, 

truncate_of f_map2 ((X,Y|B],B2),  !. 
truncate_of f_map2 ( [XI, Yl, X, Y IB) ,  (XI,  Yl,  X,  Y) )  :-   !. 
truncate_of f_map2 ( (X, Y] , (X, YJ )  :-   !. 

truncate_of f_map3 ( (XI,  Yl,  X,  Y]  ,  (XI,  Yl,  X,  Y) )  .    /*  Bdry  is  entireJy  "ff  the  map  */ 

/*  except  perhaps  for  the  last  pt .  */ 
truncate_of f_map3 ( [XI , Yl, X, Y I B] , P2)  :-  /*  Bdry  starts  off  the  map.*/ 

truncate_of f_map ((X,Y|B),B2),  !. 

assert_shortcut_f lag (Xv, Yv, Xv, Yv) . 
assert_shortcut_f lag (Xv, Yv,  Xpl,  Ypl)  : - 

assert (shortcut  (Xv, Yv, Xpl, Ypl)  )  ,  !  . 

clockwise ([Xl,Yl,c(C),Xi,yi|OP))  :- 

region_elist (R) , 

get_XYcw_edge (XI, Yl, R, [ Xa , Ya, Xb, Yb) ) , 

on_ray  (Xi,  Yi, Xl , Yl , Xb, Yb)  ,   !  . 
counterclockwise ([Xl,Y],c(C),Xi,Yi|or))   :- 
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regioti_elist  (R)  , 

get_XYccw_edge (XI, Yl, R, [ Xa , Ya , Xb, Yb] ) , 

onray  (Xi, Yi, XI, Yl, Xa, Ya) ,  !. 

get_XYcw_edge (XI, Yl,  (Xa,  Ya,  _,  _,  Xb, Yb | R] ,  (Xa, Ya, Xb, Yb] ) 

on  ray(Xl,Yl,Xlj,Yb,Xa,Ya),  !. 
getXYcwedge (XI, Yl,  (Xa,  Ya,  _, _, Xb, Yb | R} , Edge)  :- 

get_XYcw_edqe (XI, Yl, R, Edge) ,  !. 

getXYccwedge (XI, Yl,  [Xa,  Ya,  _,_, Xb, Yb j R] ,  (Xa, Ya, Xb, Yb] ) 

on_ray (XI , Yl, Xa, Ya, Xb, Yb) ,  !. 
get_XYccw_edge (XI,  Yl,  |Xa, Ya, _, _, Xb, Yb] R] , Edge)  :- 

get  XYccw  edge (XI , Yl , R, Edge) ,  !. 
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/*♦«***♦«**********«♦***********«********♦****♦**♦******************* 

A 

*  File  "boundary_ join"  or  "bj" 

A 

*  Updated  30  Jan  89 

* 

*  "bdry_join"  truncates  boundaries  and  joins  them  together  into 

*  a  network  of  the  active  boundaries  inside  a  homogeneous-cost  region. 

A 

»AAAAAAA***AAAAA*AAAAAAA***A**AA*A**AAAAA*A**AAA*A***A*AAA***AAAAAAA 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA/ 


/AAAAA*AAA**AAA***AAA**A*AAA*AA**A**AA*A*AA*AAAAA**AA**A***AAAAAA*AAA/ 
/A**A*A*A*AA*AA******A  TOP~leveJL  DTediCatG  AAAAAAAAAAAAAAAAAAAAAAAA/ 
/AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA/ 

bdry_join  :- 

initialize, 

f ir 3t_level_bdry3 (Al) , 

assert (old_bdry_3et (())), 

assert (current_bdry_set (Al) ) , 

ret ract (cur rent_bdry_set (Acur ) ) ,     /*  start  of  while-not-done  loop  */ 

retract_cut (old_bdry_3et (Aold) ) , 

not (3ame_3et (Acur, Aold) ) , 

assert (old_bdry_set (Acur) ) , 

next_level_bdrys (Acur, Anew) , 

assert (current_bdry_set (Anew) ) , 

done  (Anew) ,  /*  end  of  while-not-done  loop  */ 

get_f inal_bdrys (Af inal) , 

output  (Afinal) , 

cleanup,  halt,  ! . 
bdry_join  :- 

tell  (user) ,  nl, nl, 

writeC  Checking    for    center    shortcutting' )  ,  nl,  nl , 

eliiT\_incomplete_trees, 

get_f inalbdrys (Afinal) , 

bdry_edge_intersection3 (Afinal, BEX) , 

f ind_eKact_oppo3ite_pt  (BEI,P) , 

recurse  unless  done(r), 

output (Afinal) , 

cleanup,  halt ,  ! . 
bdry  join  : - 

tell(user),  nl,nl, 

writeC    ERROR  in  '' bdry- join' '  :  doesn' '  t  converge'  ),  nl ,  nl ,   !. 

yAA***AAA*A**«**A***AAA*AAA*A***AAAAAAAAAAAAAAAAAAAA*A*A*AAAAAAA***A«/ 
y  A  A  A  A  A  «  A  *  A  A  A  A  A  A  A  A  A  A  A  A  A  SSCOnd-leVel  predlcateS  «  a  a  a  a  a  a  a  a  a  a  a  a  a  a  a  a  a  a  a  / 
/AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA/ 

initialize  : - 

tell  (user)  , 

nl,nl,  write  (' Boundaries  being  joined:'),  nl,nl, 

abolish  (ctr , 1 )  , 

assert  (ctr  (1 ) )  . 

f ir3t_level_bdrys (A2)   :- 

number_of_edges  (ti)  , 
index_list_ItoJ (1 , N, IndexList 0) , 
cons  (IndexList 0,  (11,2]], IndexList) , 
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assert (indices (Index List) ) , 
f ir3t_level_bdrysl (A1,N) , 
order_indice3 (Al, A2) ,  !. 

next_level_bdrys (Al , A3)  :- 
reset (Al, A2) , 

propogate_next_level_bdrys (A2)  , 
get_active_bdry_set (A3)  ,  !  . 


done (A) 


one_bdry_t ree  (A) , 
tell (user) , nl, nl, nl, 
write  to  screen  (' 


DONE  -  single  bdry-tree' ) , nl, nl , nl,  ! 


get  final  bdrys (A)   :- 

get_tbdrys (A) ,  !  . 

bdry_edge__intersect ions  (  (  ]  ,  (  ]  )  . 

bdry_edge_inter  sect  ions  ([((I,J],B,Lrt]  |1.],  (([I,J],B,  LPt]  |BEI]  ) 

edge_bdry_inter section (K,  [I,J],LFt), 

bdry_edge_intersections (L, BEI) ,  ! . 
bdry_edge_inter sect  ions (([[I,J),B,Lrt]lL],BEI)  :- 

bdry  edge  inter sections (L, BEI )  ,   !. 


eiim_incomplete_trees  :- 

treedl,  J1,L,R)  , 

not  (complete_t ree (tree ( II,  J)  ,  L,R)  )  )  , 

elin\inate_tree_t  bdrys  (tree(lI,J],L,R)), 

fail,  !  . 
elim_incomplete_t rees  :-  !. 

f ind_exact_opposite_pt (BEI , P)  : - 

f ind_exact_opposite_pt 1  (BEI)  , 
opposite_edge (OE) , 
new_opp_pt  (OE,OE, P)  ,  !  . 

f ind_exact_opposit  e_pt 1  ( ( ) )  . 

f ind_exact_opposite_ptl  (([[I,J],B,  (LX,LY]J|BEI))  :- 
optinial_path  (  [  LX,  LY,  c  (C)  ,  X2,  Y2  |  OP  ]  )  , 
update_opp_edge  (I, J,  [ LX, LY, c  (C)  , X2, Y2 | OF ] ) , 
f ind_exact_opposite_ptl (BEI) ,  ! . 

recur se_unle3S  done ( [Xopp2  ,  yopp2 ) )  :- 

not  (  f i r st_pass_done) , 

oppogite_point (Xoppl, Yoppl ) , 

not  (same ( I Xoppl , Yoppl )  ,  [Xopp2, Yopp2 ) )  )  , 

ret  ract  (opposite_point  (Xoppl , Yoppl )  )  , 

assert  (opposite_point  (Xopp2, Yopp2) )  , 

assert ( fir st_pass  done), 

cleanup2, 

bg2,  !. 
recur se_unl ess_done ( [Xopp2 , Yopp2 ] )   :  - 

tell (user) , nl, nl, nl, 

write  to  screen  (' 


DONE 


Finished  Second  Pass  '  )  , nl ,  nl ,  nl ,   ! 


output (A)      : - 

write    headinq, 

wr ite_bdr y s_to_f ile (hca    opm,A),     nl,      ! 


cleanup 


aboli  sli  (ct  r  ,  1 )  , 

abolish (tbdry, ?) , 

abol  i  sh  (cur  rentb'li  y_spL  ,  1  )  , 

abolish (bdry  list,l). 
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abolish (bdry_inter section, 5) , 
abolish (initbdry, 2) , 
abolish  (tree, 3) , 
tell (user) , 
nl , nl , 

write (' Boundary  generation  complete:   results  in  file  '  '  hca_opm' ' ' ) , 
nl, nl,  !  . 
cleanup2  :- 

abolish (ct r , 1 ) , 

abolish (tbdry, 5) , 

abol i  sh (currentbdry_set , 1 ) , 

abolish (bdry_list , 1 ) , 

abolish (initbdry, 2) , 

abolish (region_elist , 1) , 

abolish (p3eudo_optimal_path, 1) , 

abolish  (tree, 3) , 

tell  (user)  , 

nl , nl , write  (' Pass  Two  beginning' ), nl , nl,  !. 

/**»*********   "initialization"  subordinate  predicates   *************/ 

/*  Assert  the  points  at  which  bdrys  are  'anchored'  to  the  region  edges  */ 
assert_anclior3  :- 

number  of_edges (M) , 

index_list_ItoJ ( 1, N, IndexList 1 ) ,  » 

asser t_anchors ( IndexList ) ,  !. 
assertanchors  (  ( 1 )  :-  !. 
a33ert_anchor3 ( [ [ I , J] I L) )  :- 

initbdry  ([I, J),  (X, Y|B))  , 

assert  (anchor (X, Y) ) , 

a3sert_anchor3 (L) ,   ! . 

reset  (A, Al )  : - 

abolish  (tbdry, 5) , 
abolish (edge_int_pt , 3) , 
order_indices (A,A1) , 
reassert _t bdrys (old,Al, 1) , 
abolish  (ct  r , 1 ) , 
assert  (ctr (1)  )  ,  !  . 


/A«A*AA*AA*AAAAAAAAAAAAA*AAAAAAA*AAAAA*AAAAA*AAAAAAAAAAAAAAAAAAAAAAA*/ 

/AAAAAAAAAA   " f i r 3 t " 1 e ve 1 " bd r y s "  subordinate  predicates  ************/ 

/A*A*AAAAA*AAAAAAA*AAAAAAAA*AAA**AAA*AAAAAA***AA**A*AA*AAAAAAA*AAA**A/ 

first  level  bdrysl(A,N)  :- 

retract  (indices  (Indej'.List)  )  , 

tr uncate_l 3t_level_bdry 3 ( Index List , N) , 

ret  ract_all_and_r  t  n_gliortest  tbdry  3  (Short  Bdrys)  , 

matching_pai  rs  (Short Bdrys, Pai red Bdrys), 

bdry_edge_inter sect  ions (ShortBdrys, EdgelntBdrys )  , 

set_subtraction  (EdgelntBdrys,  Pai  red  Bdrys,  EdgeIritBdry32)  , 

cons  (Edgel n t Bd rys2, Paired Bdrys, Act ive Bdrys)  , 

reasserttbdryg (old, Act iveBdrys, 1) , 

Uminusl  is  tJ  -  1, 

not (li3t_length (Act iveBdrys, Uminusl) ) , 

not  (lisl_lengtli  (ActiveBdrys,N)  )  , 

index_list (Act iveBdrys, IndexLl) , 

set_subtraction(lndexList, IndexLl, IndexL2) , 

/*  complement_index_li3t (N, IndexLl , lndexL2 ) ,  ♦/ 
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not (same_3et  (IndexLiat, IndexL2)  )  ,         /*  If  same,  no  new  bdry  pairs  */ 
assert (indices (IndexL2) ) , 
f irst_level_bdrysl  (A, N)  ,   !. 
f ir st_level_bdry3l (A, N)  :- 

assert_singles  (1, N) , 
get_tbdrys (A) ,  ! . 

matcbing_pairs ([FirstBj Rest], Rev Rest)  :- 

inatching_pair  si  (  (FirstBI  Rest)  ,  FirstB,  RevRest )  ,  !  . 

mat ching_pairsl  ( I  1 , _,  I ] )  : -   !  . 

matcliingpairsl  (((IDlast, Blast,  l.Ftfirst)],(IDfirst,Bfirst,l.Ptfirst], 

[  (IDlast,  Blast,  LPtfirst)  ,( IDfirst, Bfirst, Lrtfirst)  ) )  :-  !. 
matching_pair3l ([(IDlast, Blast, LP tlastJJ, (IDfirst, Bfirst, LP tfir3t),[I)  :-  !. 
maLchingpairsl  (  (  [ IDl , Bl , LPt 1 ] ,  ( ID2, B2, LPt 1 ]  | Rest ), Bfirst , 
([IDl,Bl,LPtl], (ID2,B2,LPtl)| RevRest] )  :- 
matchingpair si (Rest, Bfirst, RevRest) ,   ! . 
matching_pairsl ((B1,B2| Rest], Bfirst, RevRest)  :- 

matching_pair si ((B2| Rest), Bfirst, Rev Rest),  !. 

truncate_lst_level_bdrys (((_,_]], M)   :-  !.  /*  Base  case  */ 

truncate_lst_level_bdrys ( (  (M,  1 ] ,  (  1, 2]  J ,N)   :-         /*  Last  pair  of  bdrys:  */ 

initbdry  (  ( 1, N] ,  (XI, Yl I Bl ) )  ,  /*  succeeds  if  they  intersect.  */ 

initbdry ((1, 2), (X2,Y2|B2]) , 

bdry_inter sect  ion ((X1,Y1|B1),  [X2,Y2|B2],lntPt, Bit rune, B2trunc)  , 

get_counter_and_increment  (CO)  , 

get_counter_and_increment  (CI  )  , 

assert  (tbdry (new,  CO,  (N, 1 ) , Bit  rune, IntPt) )  , 

assert(tbdry(new,Cl,  (1,2),  B2trunc,  IntPt)  )  , 

region_elist  (R) , 

truncatebdryandedges ((1,N), (X1,Y1|B1),R), 

t r uncate_lst _level_bdrys (((_,_]], N),  !. 
truncate_lst_level_bdrys ( ( (Nminusl, N],(N,l)|Rest),N)  :- 

Nminusl  is  N-1,  /*  Next  to  Last  pair  of  bdrys:  */ 

i  nit bdry ( (Nminusl ,N),(X1,Y1|B1]),        /*  succeeds  if  they  intersect.  */ 

initbdry ( (1,N) , (X2, Y2|B2) ) , 

bdry_inter sect ion ((X1,Y1|B1], (X2,Y2|B2], IntPt, Bit rune, B2trunc) , 

get_counter_and_increment  (CO)  , 

get_count er_and_i ncrement (CI ) , 

assert (tbdry (new, CO, (Nminusl , N) , Bltrunc, IntPt) ) , 

assert  (tbdry(new,Cl,  (N,  1) , B2trune,  IntPt)  ) , 

reqion_elist (R) , 

truncate_bdry_and_edges ((N, Nminusl), (X1,Y1|B1),R), 

truneate_lst_level  bdrys ( (  [ N,  1 ]  | Rest ) , N)  ,   !  . 
truncate_lst_level_bdryg  (  (  ( I,  J]  ,  [  J,  K)  I  P.est  ]  ,  N)  :-  /*  Succeeds  if  bdrys  are*/ 

initbdry  (  (I, J) ,  (XI, Yl  I  Bl ) )  ,  /*  adjacent  and  intersect*/ 

initbdry ( [ J, K) ,  (X2, Y2  t B2 ] )  , 

bdry_inter sect  ion  ((X1,Y1|B1),  (X2,Y2|B2], IntPt, Bltrunc, B2trunc)  , 

get_counter_and_increment (CO) , 

get  counter  and  increment (CI) , 

assert(tl)dry(  new, CO,  (I,  J], Bltrunc, IntPt)), 

assert  (tbdry  (new, CI,  (J,K), B2trunc, IntPt)  )  , 

region_elist (R) , 

truncate_bdry_and_edges ([I, J), [X1,Y1|B1),R), 

truncate_lst_level_bdrys(((J,K) |Rest],N),  ! . 
truncate_lst_level_bdrys ( [ [ I , J) , ( K, L) | Rest ) , N)  :- 

ordered  ( I , J, 1 1 , Jl ) ,  /*  Recurses  if  previous   */ 

initbdry  (  [  II , J]  ) ,  [XI, Yl  I  Bl ] )  ,  /*  adjacent  and  intersect*/ 

regionelist  (R)  ,  /*  rules  liave  failed.     */ 

truncate_bdry_and_eriqes  (  [  II,  Jl  )  ,  (XI,  Yl  I  Bl  )  ,  R)  , 

truncate_lst_level_bdry.<=  (  (  (K,  L)  |  Rest  )  ,  N)  ,  !  . 

/*  As.ierts  a  temp  th'dry  which  stop.^i  at  the  region  edge  if  i  nit  bdry  ( I ,  •">)  */ 
/*  intersects  a  region  opposite  edgt^  .   Always  succeeds.   Also  assert."?    */ 
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/*  '  edge_bHry_intersection  (K,  (T,  J]  ,  (X,  Y)  )  '  for  each  inhersiect  ion  point.  */ 
truncate_bdry_and_edge3 ((I, J], (X,Y|B], (Xl,Yl,h(Q),K,X2,Y2|R))  :- 

not (bdry_3tarts_at_edge (I , J, K) ) , 

bdry_inter sect ion (|X,Y|B), [Xl,Yl,X2,Y2),IntPt, Btrunc, Bit rune) , 

get_counter_and_increment  (CO) , 

assert (edge_bdry_inter sect ion (K, [I,J),IntPt)), 

assert (tbdry (temp, CO, ( I , J) , Bt rune, IntPt ) ) ,  ! . 
truncatebdryandedges  (  (I, J] ,  [X,y|B),  [XI , Yl , _, K, X2, Y2 | R] )  :- 

truncate_bdry_aiid_edges  ([I,J),(X,Y|B),R),   !. 
truncate_bdry_and_edges ( [1,0), (X, Y|B] , 1) )  :-  !. 

assert  singles(I,N)  :-  /*  If  any  vertex's  Ist-level  bdry  */ 

Iplusl  is  I  +  1,  /*  lias  not  yet  been  generated,  do  */ 

Iplusl  <  N,  /*  so  now.  */ 

tbdry(_,_, ( I , Iplusl ],_,_) , 

assert  singles (Iplusl , N) ,  !. 
assertsingles  ( I , N)   :- 

Iplusl  is  1  +  1, 

Iplusl  <  N, 

not (tbdry (_,_, [ I , Iplusl ),_,_)) , 

initbdry ( [I, IpluslJ , B) , 

get_counter_and_increment  (Ctr) , 

assert (tbdry (new, Ct r ,  j I , Iplusl ], B, [))) , 

as3ert_singles ( Iplusl , N) ,   !. 
assert_singles  ( I , N)  :- 

Iplusl  is  I  +  1, 

Iplusl  =  N, 

tbdry (_,_, IN,1),_,_),   !. 
asaert_sinqles  ( I , N)  :- 

Iplusl  is  I  +  1, 

Iplusl  -  N, 

not (tbdry (_,_, (N, 1 ],_,_)) , 

initbdry ([1,N],B) , 

assert  (tbdry  (new, Ct r ,  ( H,  1 ] , B,  [ ]  )  )  ,   !  . 


/♦***♦*♦****«*   "next-levpl-bdrys"  subordinate  predicates   ♦♦*«***♦**/ 

propogate_next_level  bdrys  (  [ ] )  :-  !. 
propogate_next_level_bdrys ( [  [  [ I , J ) , Bl ,  ( LX, LY]  ]  I  A] )   :- 

tbdry (_,_, [K, L) , B2, (LX, LY) ) ,  /*  Previously  connected  at  end  */ 

adjacent_bdrys  (I,J,K,L,I1,J1,K1,L1), 

not (same ( I 1 , LI) ) ,  /*  Not  same  bdry  */ 

ordered (II, LI, 12,  L2)  , 

not  (tbdry (_,_,  [12, L2] ,  [LX,  LY 1) ,_)) ,    /*  Not  previously  asserted  */ 

ordered ( I 1 , Jl , 13 , J3 ) ,  /*  Use  indices  in  order  */ 

initbdry((I3,J3],BlFull) , 

ordered (II,  LI, 14, L4) , 

initbdry ( [ I  4 , L4 ] , Bl 2 )  , 

bdry  intersect  ion  (BlFull,B12,[IntX,IntY],_,B12trunc), 

within_tolerance (LX, LY, IntX, IntY) , 

get_correct_half_of_bdry (B1,B2,B12, [LX,LY), B12trunc, (X12,Y12|B12cor)), 

get_last_pt ((X12,Y12|B12cor),B12Xla3t,B12Ylast), 

g^t_counter  and  increment (CI ) , 

assert (tbdry  (new, CI,  [12, L2),  (LX,LY|B12cor),  (B12Xlast,B12Ylast])), 

propogate    next    level    bdrys (A) ,     ! . 
propogate_next_level_bdry3  (  [  I  ( I,  J]  ,  B,  LPt )  I  A)  )     :-         /*    Disregard   bdiy    w)iicli    is    */ 

propogate_next_level_bdrys (A) ,   !.        /*  paired  with  another  bdry  or  •/ 

/*  intersects  a  region  edge.    */ 
propoqate_next_level_bdry  .1  (  [  I  ( 1 ,  J  )  ,  Bl  ,  I  )  )  I  A)  )  :-      /*  Disregard  single  bdry  */ 

propogate  next  level  hdi ys  (A)  ,   !  . 
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get_correct  half_of_bdry ( [XI, Y1 |B1], [X2,Y2|B2], [X12,Y12|B12), 

(Xi, Yi J , B12tr, (Xi, Yi I B12corr J )  :-         /*  Intersect  a  line  from  Bl  */ 
Xltest  is  Xi+  (  (Xl-Xi) /20) ,       /*  to  B2  drawn  just  inside  their  pt  of*/ 
Yltest  is  Yi+ (  (Yl-Yi) /20) ,      /*  intersection,  with  the  new  bdry.  */ 
X2test  is  Xi+ (  (X2-Xi) /20) ,       /*  If  no  inters,  bdry  is  outside  Bl  */ 
Y2test  is  Yi+ (  (Y2-yi) /20)  ,       /*  and  B2,  so  this  ia  correct  half.  */ 
not (bdry_intersection_exact ( |Xltest, Yltest, X2test, Y2testJ , B12tr, _,_,_) ) , 
reverse  path_list  (B12t r ,  (_, _| B12corr ] ) ,  !.     /*  but  reversed.    */ 

get_correct_half_of_bdry (Bl ,  _,  812, 

(Xi, Yi J ,_, (Xi, Yi |B12otherhalf ] )  :-        /*  Otherwise  get  the  other  */ 
reversepathlist (B12, B12Rev) ,  /*  half  of  new  bdry.         */ 

bdry_intersect  ion(Bl,B12Rev,_,_,B12trunc) , 
reverse_path_list  (Bl2trunc,  (_, _| B12otherhalf ] )  ,  !  . 

get_active_bdty_set (_)  :- 

tbdry (new,_, (I,J),Bl,Lrtl), 

intersect_wit h_candidate_bdrys (I, J, Bl, LFtl) , 

fail,  ! . 
get_act ive_bdry_3et  (A)  :- 

retract_all_and_rti)_shortest_tbdrys (ShortBdrys) , 

whiile_changing_reasser  t_tbdrys  (Slior  tBdrys,  ^  r  _r  _)  i 

reset_last_pt s, 

get_tbdrys (A) ,  ! . 

intersect_with_candidate_bdrys (I, J, (Xl,yi |B1] ,LPtl)  :- 
get_tbdryIJorJI (F,_, [ I , K) , B2, LPt2) , 

not (same (F, temp) ) ,  /*  not  a  temporary  bdry  */ 

not (same ( (XI, YI) , LPt2) ) ,  /*  not  a  child  of  Bl     */ 

ordered (I, J, II, Jl) , 
ordered (I,  K, 12, K2)  , 

not (same ( ( II, Jl] , (12, K2) ) ) ,  /*  not  the  same  as  Bl    ♦/ 

interiorinter sect ion ((Xl,Yl|Bl],LPtl,B2,LPt2,IntPt, Bit  rune, B2trunc) , 
not  (asserted_tbdry  (  (12, K2] , IntPt)  )  ,  /*If  Bl  intersects*/ 

get_counter  and  increment  (CO) ,  /*  the  candidate,  then   */ 

assert (tbdry (temp, CO, ( 12, K2] , B2trunc, IntPt) ) ,  /*  assert  both  as  temps  */ 
not (asserted_tbdry ( (II, Jl ] , IntPt) ) ,  /*if  not  asserted  */ 
get_counter_and_increment (CI) , 

assert (tbdry (temp, CI, (II, Jl),Bltrunc, IntPt)), 
fail,   !  . 

inter9ect_with_candidate_bdrys (I, J, [XI , YI | Bl ] , LPt 1 )  :- 
get_tbdryl JorJI (F,_, (J, L] , B2, LPt2) , 

not (same (F, temp) ) ,  /*  not  a  temporary  bdry  */ 

not (same ( [XI, YI) , LPt2) ) ,  /*  not  a  child  of  Bl     */ 

ordered (I, J, II, Jl) , 
ordered  (J,  L,  J2,  1,2)  , 

not (same ( (II, Jl) , [ J2, L2) ) ) ,  /*  not  the  same  as  Bl    */ 

interior_inter sect ion ([Xl,yl|Bl],LFtl,B2,LFt2,IntPt, Bit rune, B2trunc) , 
not (asserted_tbdry ( (J2, L2) , IntPt) ) ,  /♦If  Bl  intersects*/ 

qet_counter_and_increment  (CO) ,  /*  the  candidate,  then   */ 

assert  (tbdry (temp, CO,  [J2, L2) , B2trunc, IntPt )) ,  /*  assert  both  as  temps  */ 
not (assertedtbdry ( [II, Jl) , IntPt) ) ,   /*  if  not  asserted*/ 
get_counter_and_increment (CI) , 

assert  (tbdry  (temp, CI,  (II, Jl), Bit rune, IntPt)), 
fail,   !  . 

intersect_with_candidate_bdrys (I, J, [XI, YI jBl ) , LPtl)  :-  /*  Intersect  bdry  with  ♦/ 
region  elist(B),  /*  region  edges.         */ 

truncate_bdry_aiKj_edges  ([I,J),(X1,Y1|B1),R),   !. 

asserted_thdry ( [ I , J) , LPt )   :-  /*  tbdry  is  already  asserted  */ 

tbdry (_,_, (I, J] ,_,LPt) ,   ! . 
a3gerted_tbdry ( ( I, J] ,  (Xil, Yil  ) )   :-      /*  tbdry  witli  appx=  last  pt  */ 

tbdry (_,_,[ I, J] ,_, [Xi2, Yi2] ) ,  /*  is  already  asserted  */ 

within  tolerance (Xil, Yil, Xi2, Yi2) ,   !. 
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retract  all  and  rtn  shortest  tbdrys  (  |  |  1 1 , J) , BminD, LPtminD]  | Rest ] ) 


tbdry(_,_, (I, J), (X,Y|B),_), 
ret  ract_IJ_bdry s (I , J, Bdrys) , 
get_shorte9t_tbdry (Bdrys, _, BminD, LPtminD) , 
retract_all_and_rtn_shortest_tbdry3 (Rest)  ,  ! 
retract  all  and  rtn  shortest  tbdrys  (  [ J )  :-  !. 


/*  Retract  all  IJ  bdrys 


retract_IJ_bdrys (I, J, ( ( (X, Y|B] , LPt ) | Bdrys] )  :- 
retract (tbdry(_,_, (I, J), ( X, Y | B) , LPt ) ) , 
retract_I J_bdrys (I, J, Bdrys) . 

retract_IJ_bdrys (_,_,(] )  :-  !. 

jfretract_IJ_bdry3  (I,J,X,Y,  ([[X,Y|B),  LPt  )  |  Bdrys]  ) 
retract (tbdry (_,_, (I, J] , IX, Y|B] ,LPt) ) , 
retract_IJ_bdrys (I, J, X, Y, Bdiys) . 

xretract  I J  bdrys (  ,  ,  ,  , [ ) )  : -  ! . 


/*  Retract  all  bdrys  with  */ 
/*  index  I, J,  and  return  */ 
/*  them  in  a  list  */ 

:-   /*  Retract  all  bdrys  */ 

/*  with  index  I, J  which  */ 

/*  have  same  starting  pt  */ 

/*  &  rtn  them  in  a  list  */ 


get_shortest_tbdry ((], 100000, _,_)  :-  '. 

get_shorte3t_tbdry ([ [B, LPt ] | Bdrys ] , NewMinD, NewB, NewLPt )  : - 

path_length  (B, D)  , 

get_shortest_tbdry (Bdrys, MinD, BminD, LPtminD) , 

get_minD_and_B (D,B, LPt, MinD, BminD, LPtminD, NewMinD, NewB, HewLPt ) ,   ! 
get_minD_and_B (D, B, LPtB, MinD, BminD, LPtminD, D, B, LPtB)   :-  D  <  MinD,   !. 
get_minD_and_B (D, B, LPtB, MinD, BminD, LPtminD,  MinD,  BminD, LPtminD)   : -  !  . 

while_changinq_reassert_tbdrys (Setl,Ctrl,Set2,Ctr2)  :- 

reagsert_connected_tbdry3 (Setl,Ctrl,Set2,Ctr2) , 

not  ( sameset  (Setl,Set2)), 

while_changing_reassert_t bdrys (Set2,Ctr2,_,_) ,  ! . 
while_changing_reassert_t bdrys (Setl,Ctrl,Set2,Ctr2)  :- 

same_set  (Setl,  Set^  2)  ,  !. 
while_changing_reassert_t bdrys (Set  1, Ctrl, Set2,Ctr2)  :- 

write_to_screen (' Error  in  -reassert_tbdrys-  ')rnl,!. 

rea33ert_connected_tbdrys ( ( ] , Ct r, ( ] , Ctr)  :-  !. 

reassert_connected_tbdry3 ( [ [ [ I , J] , B, LPt ] | Act Set) , Ctr , Inter iorBs, Ctr2)  : - 

connect ed_to_an_anchor ( [I, J] , B) , 

ordered (I, J, K, L) , 

assert (tbdry (old, Ctr,  [ I ,  J]  ,  B,  LPt ) )  , 

Cplusl  is  Ctr+1, 

reassert_connectedt bdrys ( Ac tSet, Cplusl, InteriorBs,Ctr2) . 
teas3ert_connected_t bdrys (( ( [I, J], B, LPt] |ActSet],Ctr, 

I [ [I, J), B, LPt] |InteriorBs],Ctr2)   :- 

reassert_connected_t bdrys (ActSet,Ctr,lnteriorBs,Ctr2) . 


connected_to_an_anchor ( ( I, J] , BO)  : - 
ad jacentedges  ( I , J)  ,  !. 

connected_to_an_anchor ( 1 1, J] ,  [X1,Y1|B])  :- 
tbdry (_,_, |K,L],B2, [X1,Y1]) , 
connect ed_to_an_anchor ( ( K, L) , B2 ) ,  ! . 

connect ed_to_ananchor ([I, J], (X1,Y11B])  :- 
tbdry {_,_, |K,L], ( XI , VI | B2 ] ,  ) , 
connected_to  an  anchor  (( K, L] , B2)  ,   !. 


/*  Bdry  starts  at  a  region  edge  */ 

/*  Bdry  starts  at  last  pt  of  */ 

/*  another  anchored  bdry.     */ 

/*  Bdry  starts  at  first  pt  of  */ 

/*  another  anchored  bdry.     */ 


/**♦***««♦********   "done"  subordinate  predicates  ******************/ 


/*  Example  'tree'  fact  (indented  for  clarity  only  -  root  is  at  left)  : 
tree((7,7],  t:ree([7,t],  tree([7,2],    t  ree  ((  7  ,  1  ),'()','(]')  , 
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tree(n,2],'  [)','()')), 
tree(l2,3],'  ()','  11')), 
tree(|3,7),  tree(l3,4J,'  I]','  D'  ), 

tree(l4,7),   tree((4,5),'  []','[]'), 

tree(l5,7],tree((5,6),'  I]'  ,'  11'  ), 

tree((6,7),'  (]','(]')))))• 

I  7,7) 
/      \ 
/  \ 

|7,3)  [3,7) 

/       \  /       \ 

[7,2)         |2,3)     (3,4)       (4,7] 
/        \  /        \ 

(7,1)       (1,2)  (4,5)       (5,7) 

/       \ 
(5,6)     (6,7)  */ 

one_bdry_tree ( ( (  [I,  J)  ,  B,  LPt)  |A) )  :- 
abolish (tree, 3 ) , 
number_of _edges (N) , 
as3ert_leaf_tree3 (1,  N)  , 
while_changing_combine_t rees (N)  , 
number_of  _t  rees  (tJT)  , 
NT  ==1,  T. 

while_changi ng  combine_t rees (N)  :- 
abolish (number_of  trees,!), 
assert  (number_of_tree3 (N)  )  , 
ret r act  (number  of _t rees (PrevNT) )  , 
combine_tree3 (1, N, NT) , 
assert (number_of_trees (NT)  )  , 
PrevNT  --    NT,  \ .  /*    fails  here  until  no  longer  changing  */ 

combine  t rees ( I , N, NumTrees)  :- 

I  <  N, 

tree([I,J],Leftl,Pightl) , 

tree ( ( J, K) , Left2, Right2) , 

not (same ( I , K) ) , 

3ucceed_if_ joined ( I , J, K) , 

retract (tree ( (I, J) , Left  1 , Right  1 ) ) , 

retract  (tree((J,K],Left2,Right2)  )  , 

assert (tree ( [I,K) , tree ( [I, J) , Left  1 , Right 1 ) , tree ( [ J, K) , Lef t2,  Right2) ) )  , 

Iplusl  is  I  ^  1 , 

combine  t rees ( Ipl usl , N, NumTrees) ,   !. 
combinet  rees  ( 1 ,  N,  NumTrees)   :-  /*  Final  case,  where  t  ree  (  (  I  ,  .J  ]  ,  ,  )  */ 

tree ( ( I, J)  ,  Leftl, Rightl) ,  /*  is  combined  with  t ree  (  ( J, I J ,  ,  )   •/ 

tree([J,I),Left2,Right2), 

not (same (Leftl, Left2) ) , 

succeedif_ joined  ( I , J, I ) ,   /*  TEMP:  always  succeeds.  Won't  always  */ 

ret ract (t ree ( ( I , J ) , Lef 1 1 , Right  1 ) ) ,         /*  succeed  for  center-s/c  */ 

retract  (tree  (  ( J,  I)  ,  Left2,  Riglit2)  )  , 

as3eEt(tree((I,I),tree((I,a],Leftl,Rightl),tree((a,I),Left2,Right2))), 

counttrees (NumTrees) ,   ! . 
combine_t rees ( I , N, 1 )   : -  /*  Last  iter,  of  while-changing  loop,  */ 

tree  (  (  I,  I  )  ,  Lef  tl,  Riglit  1 )  ,  !.    /*  where  single  tree  is  t  ree  (  I  1 ,  I  ]  ,  .  .  )  */ 
con\bine_t  rees  ( I ,  N,  NumTrees)   :- 
~I  <  N, 

Iplusl  is  I  -t  1, 

combine_t rees (Iplusl, N, NumTrees) ,  ! . 
coinbine_t rees  (N,  N,  NumTrees)   :- 

tree ( ( N,  J)  ,  Lef 1 1 , Right!)  , 

tree  (  I  J,  Kj  ,  Lef  t2,  Riglit2)  , 

not (same (N, K) ) , 
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succeed  if _ joined (N, J, K) , 
retract (tree((N, J), Le£tl,RighLl)), 
retract (tree ( [J,  K)  ,  Left 2,  Right 2) )  , 

assert  (tree ( (N,  K)  ,  tree ( [H,  J]  ,  Leftl ,  Right  1 ) , tree ( ( J, K] , Lef t 2, Right 2) ) ) , 
count_trees  (NujnTrees)  ,  !  . 
combine  t  rees  (N,  N,  NuniTrees)   :-        /*  Base  case  for  all  but  last  iteration  */ 
count  trees  (NuiiiTrees)  ,  !  . 

count  t rocs (MumTrecs)  :- 

abol  isli  (count,  1), 

assert  (count  (0)  )  , 

tree (_,_,_) , 

retract_cut  (count  (C)  )  , 

NuinTrees    is    C    +     1, 

assert (count (NumTrees) ) , 

fail,      !  . 
count_t  rees  (HuitiTrees  )     :- 

retract (count (NumTrees) )  ,  !  . 

asser t_leaf  t rees ( I , M)  :- 

I  <  N, 

Iplusl  is  I  +  1 , 

assert  (tree ([I, Iplusl  ),  [),  [))  )  , 

assert_leaf_ trees  (Iplusl, N)  ,   !  . 
asser t_leaf _t rees  (N, N)  :- 

assert  (tree((N,l),  (),[])),   !  . 

/*  Succeeds  if  bdrys  I,J  ,  J, K  ,  and  I,K  are  joined  at  one  point  */ 
succeed_if_ joined ( I, J, 1 ) . 
3ucceed_if_ joi  ned ( 1 ,  1 ,  0 )  . 
3ucceed_i  f_ joi  ned (J,  I ,  I )  . 
succeed_if _ joined (I ,  J,  K)   :- 

ordered (I, J, 11, Jl)  , 

tbdry(_,_,  [II, Jl),  lXij,Yij|Bij]  ,  ( LXi j, LYi j )  )  , 

ordered (J, K, J2, K2) , 

tbdry (_,_, 1J2,K2], [ X jk , Y jk | B jk ] , [LXjk,LYjk] ) , 

ordered (I, K, 13, K3) , 

tbdry (_,_, [13, K3] , (Xik, Yik | Bik ] , ( LX ik , LYik ] ) , 

match  3  pt  s  (Xi  j  ,  Yi  j  ,  LXi  j,  LYi  j,  X  jk  ,  Y  jk,  LX  jk  ,  LY  jk  ,  Xik,  Yik  ,  l.Xik  ,  LYik  ),!  . 


/*  Suf'ceeds  if  there  is  a  match  among  any  permutation  of  the  three  */ 

/*  pairs  of  points;  First  check  for  exact  matches:  */ 

match_3_pts (X, Y, _, _, X, Y, _, _, X, Y, _,  _) 

match_3_pts (_, _, X, Y , X, Y, _, _, X, Y, _, _) 

match_3_pts (X,Y,_,_,_,_,X,Y,X,Y,_,_) 

match_3_pts  (_,  _,  X,  Y,  _,  _,  X,  Y,  X,  Y,  _,  _) 

match_3_pt3 (X, Y, _, _, X, Y, _, _, _, _, X, Y) 

match_3_pts (_,_, X,Y,X,Y, _,_,_,_, X,Y) 

match_3_pts (X, Y ,_,_,_,_, X, Y, _,_, X, Y ) 

match_3_pts  (_,_,X,y,_,_,X,Y,_,_,X,y) 

/*  If  no  exact  match,  check  for  approximate  mat  dies:  */ 

match_?_rts (X1,Y1,_,_,X2,Y?,_,,X3,Y3,_,_)   :- 

within_to2eraiice(Xl,yi,X2,Y2), 

wit  hi n_tole ranee (X1,Y1,X3,Y3)  , 

wi  thinto] erance  (X2, Y2,X3, Y3)  ,   !  . 
match_3_pts (_,_, XI, Yl, X2, Y2,  , _ , X3 , Y3 , _, _)  :- 

within_tolerance  (X1,Y1,X2,Y2), 

wi  t hi ntol erance  (X1,Y1,X3,Y3), 

wi thin_tolerance  (X2,Y2,X3,Y3),  !. 
match_3_pt 9 (XI, Yl,_,_, X2, Y2,_,  ,_,_,X3,Y3)  :- 

wi t hi ntole ranee  (XI , Yl , X2 , Y2 )  , 

wit  hint Die ranee  (X1,Y1,X3,Y3), 

wit  hi n_tol erance (X2,Y2,X3,Y3),  !. 
match  3  pts(  ,  , XI , Y 1 , X2 , YT,  ,  ,  ,  ,X3,Y3)  :- 
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wi t hi ntole ranee  (XJ,Y1,X2,Y2), 

within_tolerance (XI, Yl, X3, X3) , 

withintolerance (X2, Y2, X3, Y3) ,  !  . 
inatch_3_pts  (XI ,  Yl ,_,_,_,_,  X2,  Y2,  X3,  Y3,  _,  _)  :- 

witliiii_tole ranee  (X1,Y1,X2,Y2)  , 

wit  hi n_tole ranee (X1,Y1,X3,Y3), 

wit hi n_tole ranee (X2,Y2,X3,Y3),  !. 
match_3_pts (_, _,  XI ,  Yl ,  _,  _,  X2,  Y2,  X3 ,  Y3, _, _)  :- 

withintole ranee  (X1,Y1,X2,Y2) , 

withintolerance (XI , Yl , X3 , Y3) , 

within_tolerance (X2,Y2,X3,Y3),  !. 
match_3_rts (X1,Y1,_,_,_,_,X2,Y2,_,_,X3,Y3)  :- 

withintolerance  (XI , Yl , X2, Y2 )  , 

withintolerance (XI , Yl , X3, Y3 ) , 

wi t hi n_tole ranee (X2 , Y2, X3, Y3 )  ,  !  . 
match_3_pts ( _, _, Xl , Yl , _, _, X2, Y2, _, _, X3, Y3)   :- 

within_toleranee (X1,Y1,X2,Y2), 

wi t hi ntole ranee  (Xl,Yl,X3,Y3), 

within_tolerance  (X2, Y2, X3, Y3)  ,   !  . 

/*********   "elim  incomplete  trees"  subordinate  predicates  *********/ 

/AAAAAAAAAAAAAAAAAAA*AAAA*AAAAAA*AA*A*AAAAAAA***A*AAAAAA*AAAAAAAA*AAA/ 

/*  Succeeds  if  top  node  of  tree  is  anchored  to  an  edge  by  means  of  */ 
/*  an  edqe-ini  er sect  ion .  If  so,  the  tree  is  'complete',  since  */ 
/*  eacli  leaf  node  is  anchored  by  means  of  a  region  vertex.  */ 

compleLe_t ree (tree([I,J],L,R))  :- 

ordered(I, J, II, Jl) , 

tbdry (_,_, (II, Jl) , [X, Y|B] ,Lrt) , 

edgf?_bdry_intersect  ion  (_,  ( II ,  Jl  ]  ,  [X,  Y]  )  ,  !  . 
complete_t ree (Lree((I,J],L,R))  :- 

ordered (I, J, II, J] ) , 

tbdry (_,_,  [11, Jl],  [X,  Y|B],  LPt)  , 

edge_bdry_inter sect ion (_, [ll,Jl],LFt),   !. 

/•  Retracts  all  bdtys  associated  with  nodes  in  'tree'  */ 

eliminate_tree_tbdry s ( I ) ) . 

eliminate_t ree_tbdry 3 (tree((I,J],L,R))   :- 

ret  ract_3ueceed (t ree ( ( 1 , J ] , _, _) ) , 

ordered (I, J, II, Jl) , 

retract_suGceed(tbdry(_,_, [11,J1),_,_) ), 

eli minate_tree    tbdrys(L), 

el  in>inate_t  ree    tbdrys(R),      !. 

/*A*AAAAAAAAAAA**AAA**AAAAAAAAA***AAA*AAAA*A*AAAAAAA*A*A*AAAAAAAAAA*A/ 

/****•**♦*♦*     "f i nd_eKact_opp_pt "    suborrlinate    predicates       ************/ 

/AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA/ 

update_opp_ed9e  (I,  J,  [  LX,  I.Y,  e  (C)  ,  X2  ,  Y2  |  OP  ]  )   :  - 
opposite_edge (OE) , 
update_opp_edge2 (I, J,  ( LX, LY , c  (C)  , X2 , Y2 | OP ] , OE)  ,   !  . 

update_opp_edge2  (I,  J,  (LX,  LY,  c  (C)  ,  X2,  Y2  |  OP  ]  ,  (Xa,  Ya,  II,  Xb,  Yb  |  OE  ]  )  :- 

on_line (LX, LY, Xa, Ya,Xb, Yb) , 

retract (opposite_edge (GEO) ) , 

update_opp_edge3 ( [LX, LY, X2 , Y2 J , | Xa , Ya ] , GEO, OEl ) , 

assert (oppoai t e_edge (OEl ) ) ,  ! . 
update_opp_edgR2  (I,  J,  (  LX,  LY  ,  c  (C)  ,  X2  ,  Y2  |  GP  J  ,  (  Xa  ,  Ya  ,  I!,  Xh,  Yb  |  OE  )  )   :  - 

update_opp_edge2  (I, J,  ( LX,  LY ,  c (C)  , X2 , Y2 | OF ] ,  [Xb, Yb|GE] )  , 
update_orT_edqe2  {1  , J,   [ LX , LY , c (C)  , X2 ,  Y2 | Or ) ,  |  J )  . 

/*  If  OP  is  cnunterclocJ'.wise  alonu  opp  eiJy? :  */ 
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te_opp_edgp3  (  1 1,X,  LY,  X2,  Y2  )  ,  (Xa,  Ya]  ,  (Xa,  Ya,  H,Xb,  Yb|OE0]  , 

[Xa, Ya, h  (o)  , X2, Y2,  li  (ccw)  , LX, LY, H, Xb, YbJOEO] )   :- 

onray  (X2,  Y2,  LX,  LY,  Xa,  Ya)  ,  !  . 
f  OF  is  clockwiae  along  opp  edge:  */ 
te_opp_edge3 ( [LX,LY,X2, Y2] ,  lXa,Ya),  (Xa, Ya, H, Xb, Yb | OEO] , 

{Xa, Ya, H, L2, L2, h (cw)  , X2, Y2, h  (o)  , Xb, YblOEO] )   :- 

onray (X2, Y2, LX, LY, Xb, Yb) , ! . 
f  OP  is  neither  cloc)cwise  or  ccw  then  it  goes  into  HCA  interior  or  it  */ 
oes  toward  goal  into  HCA  exterior,  so  it  says  nothing  about  opp  point  */ 
te_opp_edge3 ( [LX, LY, X2, Y2 ) ,  [Xa, Ya] ,  [Xa,  Ya,  H, Xb, Yb | OEO] , 

(Xa, Ya, H,Xb, YblOEO] )   :-  !. 
f  LX, LY  is  not  on  current  opp  edge  segment,  recurse  to  next  segment  */ 
te_opp_edge3 ( [ LX, LY, X2, Y2] , [Xa, Ya] , [Xb, Yb, H|OE0] , [Xb, Yb, H | OEl ] )  :- 

not (same ( [Xa, Ya] , [Xb, Yb] ) ) , 

update_opp_edge3 ( [ LX, LY, X2, Y2 ] , [Xa, Ya] , OEO, OEl ) ,   ! . 


*   "update_opposite_edge"  subordinate  predicates  ********/ 

AA**AAAAA*A*A*AAA**AA*AAAAA*AAAAAAAAAAAA*AAAAAAAAAAAAAAAAA/ 


/AAAAAAAAAAAAAAAAAAAAAA 
/AAAAAAAAAAA 


I*    iiew_opp_pL  finds  a  new  (&  correct)  opposite  point  if  one  is 
/*  present,  or  rtns  orig  opp  pt .  If  it  recurses  thru  whole  list 
/*  with  h (o)  for  each  edge,  initial  opp  pt  was  good.   If  it 
/*  finds  a  label  other  tlian  h  (o)  ,  then  it  needs  new  opp  point. 
new_oi.p_pt  (_,  [_,_,  h  (o)  ,_,_]  ,  [Xopp,  Ycp()]  )   :- 

opposite_point (Xopp, Yopp) ,   ! . 
new_opp_pL  (_,  [Xl,  Yl,  li  (o)  ,  X2,  Y2  lOEl  ,  F)  :- 

new_opp_pt ( |X1, Yl] , [X2, Y2 |OE] , F) ,   ! . 
new_opp_pt  (  , (XI, Yl, h (ccw) ,X2,Y2,_,X3,Y3],F)  :- 
optimal_path ( (XI, Yl |_] , Cccw) , 
oe_bisection_search (X2,Y2,X3,Y3,Xcw,Ycw) , 
opt imal_pat h ( ( Xcw, Yew | _] , Ccw) , 
calc_opp_pt  (XI, Yl, Xcw, Yew, Cccw, Ccw, P)  ,   !  . 
new_opp_pt ((XO, YO] , (Xl, Yl,h(cw) ,X2,Y2|_],P)   :- 
optimal_path ( [X2, Y2 |_) , Ccw) , 

oe_bi3ection_3earch (Xl,Yl,XO,YO,Xccw,Yccw), 
optimal_path  (  [Xccw, Yccw |  ] , Cccw)  , 
calc_opp_pt (X2,Y2, Xccw, Yccw, Ccw, Cccw, F) ,  ! . 


oe_bisection_search (X1,Y1,X2,Y2,X,Y)   :- 

XiO  is  XI  +  (X2-X1) 12, 

YiO  is  Yl  +  (Y2-Y1  )  /2, 

round_to_4decpl  (XiO, Xi ) , 

round_to_4decpl (YiO, Yi) , 

optimal_path ( ( Xi , Yi , c (C) , X, Y | OF ] ) , 

online (X, Y, XI , Yl , X2, Y2 ) ,  !  . 
oe_bisection_search (X1,Y1,X2,Y2,X,Y)   :- 

XiO  is  XI  +  (X2-X1 ) 12, 

YiO  is  Yl  +  (Y2-Y1) /2, 

round_to_4decpl (XiO, Xi) , 

round_to_4decpl  (YiO,Yi)  , 

not  ( wi t hi ntole ranee  (Xi , Yi , X 1 , Yl )  )  , 

oe_bisectioii_search  (Xl,Yl,Xi,Yi,X,Y), 
oe_bi sec tion_se arch (X1,Y1,X2,Y2,X,Y)   :- 

Xi  is  XI  t  (X2-X] ) /2, 

Yi  is  Yl  4   (Y2-il  )  /2, 

wil-hin_to]erance  (Xi,Yi,Xl,Y]), 

telJ  (mi ssing_ops ) , 

write  ('Heed    OF    for    start-point     '), 

WI  i  f  o  (  [Xi  ,  Yi  1  )  ,  111  , 

t  e  ]  ]  ( 1 1  p  e  r  )  , 

wr  i  t  e  ( '  WAP.tllMG  :    missing    cp^il^.^l     path 

write  ('  for  predicate  '  '  oe  bi 


/*  Bisect  edge;  compute  OF  */ 

/*  from  midpt;  if  OF  staiLs*/ 

/*  along  edge,  this  is  the  */ 

/*  point  we  are  looJcing  for*/ 


/*  If  OF  doe.T  not  start  on  */ 
/*  edge,  search  between  */ 
/*  point  1  and  j'oint  i.      */ 


/*  If  no  correct  OF  is  •/ 

/*  found,  return  Ft   1  as  */ 

/*  answer.  Tlii  r>  case  */ 

/*  SHOUL['  NOT  HAFFEtl,   so  */ 

/*  print  a  waininj.  */ 


from  opposit  e  eda*^'  )  ,  nl  , 
section  sear ch' ' ' ) , nl ,   ! 


:a7 


/.*«*.«**********   "output"  subordinate  predicates  *****************/ 

wr i te_bdrys_t of ile (hcaopm, |]) . 

write_bdrys_to_f ile (hcaopm,  (  (  ( 1 ,  J)  ,  B,  LPt )  | DdrySet ) )   :- 

tell  (lica_opn\)  , 

write  ('bdry  ('  )  , 

write ( II, J) ) , write (','), write (B) , 

write(').'),nl, 

writ e_bdrys_to_f ile (hca_opm,  BdrySet)  . 

write_iter_to_screen  : - 

retract (number_of_iter (I) )  , 

Iplusl  is  1  +  1, 

assert  (nunii.)er  of_iter  ( Iplusl )  )  , 

tell  (user ) , 

wr it e  (' consistency  check  '), 

wr  i te  ( I )  , nl ,   !  . 
wr ite_heading  :- 

region_vertices ( (X, Y  t  R] )  ,  goal_point (Xg, Yg)  , 

cons ((X,Y|R), |X,Y), Region) , 

t  e  1 1  ( Ilea  opm)  , 


t  e  1 1  ( Ilea  opm)  , 

1 isting (title) , 

write('region('  )  ,write( Region)  ,write('  )  .'  )  ,nl, 

write ('goal  (  ('  )  , write (Xg)  , write  ('  ,  '  )  , write  (Yg)  , write  (' 

list  ing (tree)  ,   !  . 


eC  ))  .'  )  ,nl, 


write_to  screen(X)  : - 
tell  (user) , 
write (X)  , nl,  !  . 


y****A***********A**A**   utilitv  predicates   ************************/ 

/***AAAA*AAAAAA**AAAAAA**AA*****AAA*AAAA*AAA**AAAA*AA*A**AAAA**AAAAA*/ 

/*  Succeeds  if  line  segments  intersect,  but  do  not  share  an  endpoint .  */ 

interior_intersection((Xl,Y] |Bl],Lrtl, lX2,Y2|B2),LPt2,IntFt,Bltr,B2tr)  :- 

not (same (LPtl, LPt2) ) ,  /*  If  inters  at  endpt,  fails;  if  not,*/ 

not ( same ((X1,Y1),(X2,Y2))),        /*  and  intersects  somewhere,  succeeds*/ 
not (same ( 1X1, Yl] , LFt2) ) ,  /*  Assumes  Bl  S  B2  intersect      */ 

not (same ( 1X2, Y2] , LFtl) ) ,  /*  in  at  most  one  point.  */ 

bdry_inter sect  ion ([X1,Y1|B1),  (X2,Y2|B2],IntPt,Bltr,B2tr),   !. 

interior_intersection ( (XI, Yl  |B1] ,  I  ] ,  (X2, Y2|B2] ,  [ ] ,  IntPt, Bltr,B2tr)  :-   /*  Full*/ 
bdry_inter sect  ion (lXl,Yl|Bl],[X2,Y2|B2],IntPt,Bltr,B2tr),   !.  /*bdrys*/ 

/*  Full  bdrys*/ 

/* 

*  ' bdryi ntersect ion'  determines  ttie  intersection  of  two  boundaries, 

*  or  fails  if  there  is  no  intersection.   The  boundaries  are 

*  piecewise  linear, and  are  represented  as  a  list  of  points, 

*  ie,   I xl , yl , x2, y2, x3, y3, . . . ] .   Tolerance  is  allowed. 

*  One  an  intersection  is  found,  it  is  cached  to  speed  up  future  references  */ 
bdryintersection (Bl, B2, ( Xi2, Yi2 ] , Bit r 2 , B2t r2 )   :- 

brlry  inter  sect  ion]  (appx,  B1,B2,  lXi,Yi], Bit  rune, B2trunc)  , 

Xi2  Ts  (floor (Xi*10000) /lOOOO) , 

Yi2  is  (floor (yi*10000) /lOOOO) , 

rpp]ace_Jast_coord3 (Bltrunc,  lXi2,Yi2),Bltr2), 

replace  last_coords (B2t r unc, [Xi2 , Yi2 ] , B2t r2) , 

asserta(bdry  intersection (B1,B2, [Xi2,Yi2),Bltr2,B2tr2)),   !. 
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/*  'bd 

*  no 

*  bot 
bdry  i 


/•  Clie 
bdry  i 


/•  Rec 
bdry  i 


/*  Rec 
bdry_i 


bdry_i 


bdry_i 


bdry  i 


ry  intersection  exact'  is  like  ' hclry_int ersect ion' ,  except  that 
tolerance  ia  allowed  on  intersection  point  being  interior  to 
h  bdrys,  and  bdry_intersect ions  are  not  cached.  */ 
ntersection_exact (Bl, B2, ( Xi2, Yi2 ) , Bltr2, B2tr2)  :- 

bdry_intersect ionl (exact, Bl, 82, (Xi,Yi), Bit rune, B2trunc) , 

Xi2  is  (floor  (Xi*10000) /lOOOO)  , 

Yi2  is  (floor  {Yi*10000) /lOOOO) , 

replace_last_coords (Bit  rune,  (Xi2,Yi2),Bltr2), 

replace_last  coords (B2trunc, (XJ2,Yi2],n2tr2), !. 
ck  if  any  segment  of  bdry  1  matches  the  1st  segment  of  bdry  2.  */ 
ntersectionl(Prec, 1X11,Y11,X12,Y12|B1J, [X21,Y21,X22,Y22|B2], [Xi,Yi), 

Bltrunc, B2t r unc)  :- 

bdryi  liter  sect  ion2  (Tree,  (X11,Y11,X12,Y12|B1), 

(X21, Y21,X2 2, Y22],|Xi,Yi], Bltrunc, B2trunc)  ,   •  . 
ursiveJy  check  the  next  segment  of  boundary  2  with  all  of  bdry  1.   */ 
ntersectionl(Prec, (X11,Y11,X12,Y12|B1], [X21,Y21,X22,Y22|B2], [Xi,YiJ, 

Bltrunc, (X21, Y21 I B2trunc] )  :- 

bdry_inter sect ionl (Free,  tXll,Yll,X12,Y12|BlJ, 

(X22,Y22|B2], (Xi,Yi], Bltrunc, B2trunc) ,   ! . 
ursively  see  if  any  seg  of  bdry  1  matches  the  1st  segment  of  bdry  2. 
nter3ection2 (appx, (X11,Y11,X12,Y12|B1], 

(X21, Y21, X22, Y22] , (Xi,Yil, ( XI 1 , Yl 1 , Xi , Yi ] , ( X2 1 , Y2 1 , Xi , Yi ] )   :- 

line_inter sect  ion (Xll,Yll,X12,Y12,X21,Y21,X22,Y22,Xi,Yi), 

between (Xi,Xll,X12), 

between(Yi, Yll, Y12) ,  /* 

between  (Xi, X21, X22) ,  /* 

between  (Yi, Y21, Y22)  ,   !.  /* 

nter3ection2  (appx,  (X11,Y11,X12,Y12|B1], 

[X21, ¥21 ,X22, Y22] ,  [Xi , Yi ] ,  [XI] , Y] )  [Bltrunc] , B2trunc)   :- 

bdry_intersection2 (appx, [X12,Y12[B1], 

(X21, Y21,X2 2, Y22j,(Xi,Yi), Bltrunc, B2trunc) ,   ! . 
ntersection2  (exact,  [X11,Y11,X12,Y12|B1], 

[X21, Y21,X22, Y22] ,  [Xi,Yi],  [XI 1 , Yl 1 , Xi, Yi ] ,  [X21 , Y2 1 , Xi , Yi ] ) 

lineinter sect ion (Xll,Yll,X12,Y12,X21,Y21,X22,Y22,Xi,Yi), 

e:iact_between  (Xi,  X11,X12)  , 

exact_between (Yi,Yll,Y12) , 

exact_lietween  (Xi  ,  X21,  X22)  , 

exact_between (Yi , ¥21, Y22) ,  !. 
ntersection2  (exact,  [X11,Y11,X12,Y12 

[X21, Y21,X22, Y22) , [Xi,Yi), [XI 1, Yl 1 | Bltrunc ], B2trunc) 

biJry_inter3ection2  (exact,  [X12,Y12|B1), 

[X2],Y21,X22,Y22],  [Xi,Yi),  Bltrunc, B2tr unc),   !. 


Check  if  pt  i  is  between 
endpoints  of  both  segments 
inclusively 


*/ 
*/ 
*/ 


Check  if  pt  i  is  between  */ 
endpoints  of  both  segments  */ 
inclusively  */ 


Bl 


replace_last_coords (!_,_], |X,Y], [X,Y]) . 
replace_last_coords  (  [Xi, Yi I L) ,  (X,Y],  [Xi,Yi|L2] 
replace  last  coords (L, [X, Y ], L2) ,   !. 


get_tbdtyIJor JI (F, C, ( I, J] , B, LFt ) 
get_tbdryIJorJI(F,C, [l,J],B,LPt) 


:-  tbdry (F, C, [ I, J) , B, LPt ) 
:-  tbdry (F,C, [J, I], B,LPt) 


rea9sert_tbdrys(F, [l,Ctr) . 

reassert_tbdry3 (F,  [  [  ( I , J ] , B, LPt )  I  A3 ) , Ct r )   :- 

assert(tbdry(F,Ctr,[I,J],B,LPt)), 

C2  is  Ctr+1, 

rea3sert_tbdry3 (F , A3,  C2)  ,  !. 

orderindices([),[))  :-  !. 

ordei_indices  (  I  [  (  I ,  J  ]  ,  B,  l.Pt  )  j  Rest  )  ,  (  (  [  II ,  Jl  )  ,  B,  LPt  )  j  RevisedRest  )  ) 

ordered (I, J, II, Jl ) , 

order  indices (Rest, RevisedRest)  ,   !  . 

adjacent  bd  r  y  s  ( I  ,  .T,  j,  K,  I  ,  J,  J,  K)  :-  !. 
arl  jacent_bdrys  (1,  J,  K,  J,  1,  J,  J,  K)  :-  !. 
ad jacent_bdry3 (I, J, I , K, J, I, I, K)     :-     !. 
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ad jacent_bdry3 (I, J, K, 1, J, I, I, K)  :-  !. 

ad jacent_edges ( I , J)   :-  J  is  I  4  1. 

ad jacent_edges ( 1 , N)  :-  number_of_edge3 (N) 


get_initbdryl Jor JI (I, J, B) 
get_initbdryl Jor Jl (I, J, B) 


ini tbdry ( (l,a) , B) 
initbdry  (  [ J,  I) , B) 


get_tbdry3 (_)  :- 

assert (bdry_list  ([])), 

tbdry (_,_, [I, J),B,LPtB) , 

retract_CLit  (bdry_list  (L)  )  , 

assert (bdry_list (([lI,J),B,LrtBJ|L))), 

fail. 
get_tbdry3 (A)  :-  ret ract (bdrylist (A) ) ,  !. 


re3et_lagt_pts  :-  /' 

tbdry  (Fl,  CI,  (1,^^)  ,  PI.  (l.Xl,  LYl  ]  )  ,    /' 
tbdry  (F2,C2,  IK,L] ,B2,  1LX2,LY2] )  , 
ad jacent_bdryg (I,J,K,L, I1,J1,K1,L1) , 
not  (same (( I , J  J ,  (K,L) )  )  , 
withintolerance  (LXl,  LY]  ,  LX2,  I,Y2)  , 
retractcut (tbdry  (r2,C2,  |K, L] ,B2,  (LX2,LY2] )  )  , 
assert a (tbdry  (F2,C2,  [K, L] ,B2,  [LXl, LYl] )  )  , 
fail,   ! . 

reset  last  pis  :-  !. 


Insures  that  intersecting  */ 

bdrys  have  identical  last  points  •/ 


edgead jacent_to_bdry ( I , I , J) . 
edge  adjacent  to  bdry(J,I,J) . 


bdry_st  art  s  at_edqe ( 1 , J, J) 
bdrystart s_at_edge ( I ,  J,  3 ) 
bdrystart s_at_edge ( 1 ,  H,  1 ) 
bdry_3tarts_at_edge  (1,  H,  11) 
bdry_start s_at_edge (N,  1,  1) 
bdry  starts  at  edge(tJ,],N) 


Diff  is  I-J,  ab3(Diff,l), 
Liiff  i3  I-J,  abs(Diff,l), 
number_of_edges (H)  , 
number  of  edges  (N)  , 
nnmber_of _edge3 (N) , 
number_of_edge3 (H) , 


/*  Opp  rt  is  located  proportional  to  OP  costs  at  each  end  */ 
calc_opp_pt (X1,Y1,X2,Y2,C1,C2, (Xopp, Yopp] )  :- 

distance  (XI, Y1,X2,Y2,D12) , 

DelX  is  X2  -  XI,  DeJY  is  Y2  -  Yl, 

XoppO  is  XI  +  (  (D12  +  C2-C1) /D]2)  *  (Pe]X/2) , 

YoppO  is  Yl  +  (  (D12+C2-C1)  /D12)  *  (DelY/2)  , 

round_to_4decpl (XoppO, Xopp) , 

round_to_4decpl (YoppO, Yopp) ,   !. 

/•  Rounds  off  a  numljer  to  four  decimal  places  (to  allow  unification   */ 

/*  with  manually  input  optimal  paths)  */ 

round_to_4decpl (X,Xr)  :-  Xr  is  (floor  (  (X i 0 . 00005) *  10000) ) /lOOOO . 
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************************************************************************ 

* 

*  "bgutils"  contains  supporting  predicates  used  by  the  "bg"  files. 

* 

*  Consulted  and  called  by  "bg" . 

* 

*  Updated  12  Jan  89. 

* 

************************************************************************ 

************************************************************************/ 

/*  CONSTANTS:  Dimensions  of  input  map  */ 
minX  (0)  . 
maxX (80)  . 
minY  (0)  . 
maxY (100)  . 

pi (3 . 14159)  . 

/*  "precision"  is  the  ma:t  number  of  line  segments  to  compute  */ 

/*  for  each  Ivis  boundary,  and  twice  the  number  for  2vis  boundaries.   */ 

precision  (20)  . 

tolerance (0 . 05) .     /*  Pts  closer  than  this  are  usually  not  distinguished  */ 
/*  tolerance (0 . 015) .  */ 

/********************************************************************/ 
/******************  qeneral  utility  predicates  ***♦****************/ 
/********************************************************************/ 

between (B, A, C)   :- 

tolerance  (T)  , 

Dp] us  is  B  I  T, 

Cplus  is  C  +  T, 

A  ^<    Bplus, 

B  =<  Cplus,   ! . 
between (P, A, C)   :- 

tolerance  (T)  , 

Bminus  is  B  -  T, 

Cminus  is  C  -  T, 

A  >=  Bminus, 

B  >=  Cminus,   ! . 

exact_beLween (B, A, C)   :- 

A  =<  D, 

B  =<  C,   ! . 
exact_bet ween (B, A, C)  :- 

A  >=  B, 

B  >=  C,  ! . 

st  r  ict  ly_l;'et  ween  (B,  A,  C)   :- 

A  <  B, 

B  <  C,   f  . 
St rictly_between (B, A, C)   :- 

A  >  B, 

B  >  C,   !  . 

got_couiiLe  J.    and    incr  emoiU.  (Ct  i  )      :- 
retract (ctr  (Ctr )  )  , 
Cplusl     is    Ctr     I     1, 
assert  (ctr (Cplusl ))  ,      !. 
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ordere^l  (I,  J,  I,  J)   :-  I  =<  J,   !  . 
ordered  (1, J, J, 1)   :  -  !  . 

ab3 (X, X)   : -  X  >=  0 . 

ab3(X,Y)   :-  X  =<  0,  Y  is  -X. 

ret ract_3ucceed (P )   :-  retract (T),   !.   /*  Always  succeeds,  fails  on  backtrack  */ 
retract_3ucceed (_)  :-  !. 

ret ract_cut (P)  :-  ret ract  (P) , ! .        /*  Retracts  P,  fails  on  backtracking  */ 

unify  cut  (  P  )   :  -  en  1  1  ( I' )  ,  !  .    /  *  (lf^^  n  1  nl   i  nnt  nnco  of  P  ,   f  n  i  1  n  on  brickl  rack  i  nf(  *  / 

/*  faiJs  tlie  first  time  calletl,  then  succeeds,  toggling  thereafter  */ 
fail_succeed  :-  not (failed),  assert  ( failed) ,  !,  fail,  !. 
fail  succeed  :-  failed,  ret ract  (failed) ,  !. 


getlastpt  ((Xlast,Yla9t),Xlast,yiast)  . 
get_la3t_pt ( ( X, Y | Rest ]  ,  Xlast  ,  Ylast )  :- 
getlastpt  (Rest , Xlast , Ylast )  . 

get_last_l ist  (( Last |  ,  Last )  . 
get_last_list ( [F I  Rest ]  ,  Last )  :- 

get_last_list (Rest , Last ) . 

within_tolerance (XI,  Yl,  X2, Y2)   :- 
tolerance (Tolerance) , 
De]X  is  X1-X2, 
DelX  <  Tolerance, 
DelX  >  -Tolerance, 
DelY  is  Y1-Y2, 
DelY  <  Tolerance, 
DelY  >  -Tolerance,   ! . 

saine_set  (Setl,  Set2)  :- 

same (Setl, SeL2) ,  !  . 
sameset ( (A ISetl I , Set?)   :- 

match_and_delete (A, Set2, Set2LessA) , 

saine_set  (Set  1 ,  5et2LcssA)  ,   !. 

matcli_and_delete  (A,  (A)  ,  (  )  )  . 
match_and_delete (A,  |A| Rest],  Pest)  . 
match_and_delete  (A,  [PlSet],  (  P  |  Set  L-^ssA]  )  :- 
n\atch_and_delete  (A,  Set,  SetLessA)  . 

/*  input:  starting  and  ending  inteaers  */ 

/*  output:  list  of  lists  of  the  form  [  [  1 ,  2  ]  ,  [  2,  3  ]  ,  .  .  .  ,  (N-1 ,  N]  ,  ( t-I,  1  )  ]  */ 

/*  where  an  index  pair  appears  the  nun\  of  times  its  initbdry  appears  */ 

inde::_list_ItoJ  (J,  J,  1  [  J,  1  )  J  )   :-   !. 

index_list_ItoJ ( I ,  J,  (  ( I  ,  Iplus 1 )  | Rest )  )     :- 

1  f  1 1  u  3  1     i  s     I     +     1  , 

i  nrlexli  3t_7toJ(lplusl,.1,Re3t),      !. 


/*     returns    the    number    of    ini t bdry  (  [ I , J j 
nuiri)jer_of     I.l    i  ni  tl>di  y  s  (  T  ,  .1 ,  tl)      :- 

assert (temp_num(0) ) , 

initbdry (Ii7jJ,_) , 

retract_cut  ( temp_nuin  (K)  )  , 

KfJusl     is    K-t  1  , 

assert  ( t en\p    nuiii  ( F.p lus  1  )  )  , 

fail,      !  . 
nunUjor_of     I  J    i  nitbdry  s  ( I ,  J,  1')      :- 

ret  r  act_cut  ( temp_nuiii  (H)  )  ,      !  . 


) ' s    asserted    * / 
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/*  input:  li?t  of  3-element  bdry  li^^s  of  form  [ ( ( 1 , 2 ) , Bl , LPt 1 ] , . . . )  */ 
/*  output:  list  of  lists  of  the  form  ((1,2),  [2, 3],...)  where  eacli  */ 
/*  bdry  in  input  list  is  represented  by  its  index  list     */ 

index] ist  ([),[])  :-  !  . 

index_li3t  (  I  I  [  I ,  J]  ,  _,  _)  I  Rest  ]  ,  (  ( I  - '^  1  IRevList]  )  :- 
index_list (Rest , RevList)  ,  !. 

/*  input:  Num  of  edges  and  list  of  indices  of  each  bdry  previously  asserted  */ 
/*  output:  list  of  indices  of  each  bdry  not  previously  asserted  */ 
complement_indej:_list (N,  [ I  1, 2]  llnList] ,OutList)  :-    /*  If  [1,2]  is  first  */ 


complement  index  list  1  (N,  H,  I  | N,  1 )  )  ,  Fir st ,  Fir st )   :-   !. 
complement_index_listl  (N,  M,  I  (1,  2)  ) , First,  (  |N, 1 J  1  )  :-   !. 
complement_index_listl (N,H,  [  [N, 1) ,  (1, 2)  ] ,First,  [] )  :-   ! 
coiMplementindexlist 1(1, M,  ([I, J]  I  Rest], First,  RevIndexList )   : - 

IpluslisI+1, 

complement  index  list  1  ( Iplusl , H, Rest , Fi rst , RevIndexList )  ,  !. 
complement_indexl istl  (I,H,  [(J,K)  | Rest], First,  [[I,  Iplusl]  | RevIndexList] )   : - 

Iplusl  is  I  +  1, 

not ( same (I , J) ) , 

comp 1 erne nt_index_l ist 1  (Iplusl, U,  1[J,K]  | Rest], First, RevIndexList )  ,   !  . 

set_subtraction(L,  (],I.)  :-  !. 
setsubLract  ion  (LI,  ( A  I  L2  ]  ,  L-J )  :- 

delete_f rom_list (A, LI, L3) , 

set_9ubt ract ion (L3, L2, L4 ) ,   !. 

delete_f rom_] ist (A, [ ] , 1 ] )   :-  !. 
delete_f rom_list (A, |A| L] , L2)  :- 

delete_f romlist (A, L, L2) ,  !. 
delete^f romlist ( A, | B | L) , ( B | L2 ] )  : - 

delete_f  roni_list  (A,  L,  L2)  ,   !. 

/* 
*  predicates  related  to  rotation  and  translation  of  the  boundary. 

V 

compute_angl f_ of_rotation (Xo, Yo, X, Y, Angle)  :-      /*  Computes  angle  to  rot.*/ 

t)elX  is  X-Xo,  /*  the  x-axis  to  tlie  */ 

DelX  >-  0,  /*  vector  (Xo, Yo) ->  (X, Y )  */ 

DelY  is  Y-Yo,  /*  when  the  anqie  is  */ 

Angle  is  -asin  (Del Y/sqr t  (DelX' 2  I DelY^2 )  )  .  /*  between  -pi/2  S  pi/2,  */ 

compute_anq 1 eof  rot  at  ion (Xo, Yo, X, Y, Angle)  :- 

DelY  is  Y-Yo,  /*  ...wlieii  the  anqle  is  */ 

I'elY  >-  0,  /*  between  pi/2  &  pi  ■  */ 
DelX  is  X-Xo, 

Angle  is  -Pi  +  as i n  (I'el  Y/ sqr  t  (L'elX  '  2  I  Pel Y "2 )  )  . 
compute_ainie_of  rotation  (Xo, Yo, X, Y, Angle)   :- 

UelY  is  Y-Yo,  /*  ...when  t  h<»  anale  is   */ 

DelY  <  0,  /*  between  pi  f.    3pi/2.    •/ 

DelX  is  X-Xo, 

pi  (fi)  , 

Angle  is  F i ( as i n (He  1 Y/ sgr t  (De J  X' 2  I  Del Y " 2 )  )  . 

invert  bdry  :-  /•  Reflect.i  the  bo'ui'lary    ', 

ret ract  (bdry  (P)  )  ,  /*  about  the  vertical  line  */ 
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invert    bdry  (P,  Vx,  P_inv)  ,  /*    X=Vx,     where    Vx    13    tlie  */ 

assert  (bdry (R_inv) ) ,  !.  /*  bdry  vertex  or  last  pair*/ 

invert_bdry ( (X, Y) , X, (X, Y] ) .  /*  of  coords  in  bdry  list   */ 

invert_bdi.y  (  [X,  Y|R]  ,Xrefl,  [Xinv,  Yinv  |  Rinv]  )  :- 

invert_bdry (R, Xref 1, Rinv) , 

invert_coords (X, Y, Xrefl, Xinv, Yinv) . 
invert  coords (X, Y, Xre fl , Xinv, Y )   :- 

Xinv  is  2*Xiefl  -  X. 

rotate_bdt y (Angle)   :- 

retract (bdry (L) ) , 

rotate_bdry  (I.,Anqle,,_,Lrot)  , 

assert  (bdry (Lrot)  )  ,   !  . 
rotate_bdry ( [X, Y) , Angle, X, Y, (X, Y] ) .  /*  Assumes  last  item  in  */ 

/*list  is  bdry  vertex  */ 
rotate_bdry  (  [X,  Y|  1.)  ,  Angle,  Xo,Yo,  (Xrot ,  Yrot  |  Lrot  J  )   :- 

rotatebdry (L, Angle, Xo, Yo, Lrot) , 

translatepoint  (X, Y, Xo, Yo, Xtr, Ytr ) , 

rotate_point (Xtr, Ytr, Angle, Xrotl,Yrotl) , 

ret ranglate_point (Xrotl , Yrotl, Xo, Yo, Xrot , Yrot ) . 
rotatepoint (X, Y, Angle, Xrot, Yrot)   :- 

Xrot  is  X*cos (Angle)  +  Y* sin (Angle) , 

Yrot  is  Y*co3 (Angle)  -  X*sin(Angle) . 

rotate2_bflry  (Angle)      :- 

retract (bdry  (L) ) , 

rotate2_bdry (L, Angle, _, _, Lrot ) , 

assert  (bdry (Lrot)  ) ,   !  . 
rotate2_bdry ( [X, Y) , Angle, X, Y, []) .  /*  Assumes  last  item  in  */ 

/*list  is  origin  of  rotation,  but  not  on  boundary  */ 
rotate2_bdry ( [X, Y I L) , Angle,Xo, Yo, ( Xrot , Yrot I Lrot ) )   :- 

rotal:  e2_bclry  (L,  Angle,  Xo,  Yo,  Lrot )  , 

t  ranslate_point  (X, Y, Xo, Yo, Xt  r , Yt i )  , 

rotate_point  (Xtr, Ytr, Angle, Xrotl, Yrotl)  , 

re_t ranslate_point (Xrotl , Yrotl, Xo, Yo, Xrot, Yrot) . 

translatepoint (X,Y,Xo,Yo,Xtr,Ytr)   :- 

Xtr  is  X-Xo, 

Ytr  is  Y-Yo. 
re_translate_point (Xtr,Ytr,Xo,Yo,X,Y)  :- 

X  is  Xtr^Xo, 

Y  is  Ytr4Yo. 


/' 


Miscellaneous  utility  predicates. 

•/ 


debug_list (Filename) 

tell  (Filename; 

1 i  St  i  ng (goal_poi  nt  )  , 
iree) 


LSL (ri±ename)   :- 
tell (Filename ) , 

listing (region_ver  tices)  ,  1 i  sting  (^  i  tie)  ,  li; 
listing  (tbdry)  , listing (initbdry)  , listing  (ti 


reversel ist  ( ( ) , | ) ) . 

rever  se_list  ([X(L),Revl,consX)   :- 
reverse_li3t (L, RevL) , 
cons (RevL,  [X  J , RevLconsX)  . 

rever se_edge_l ist  (  [X, Y) ,  (X, Y] )  . 

reverse_edge_li3t  (  (X,  Y,  H  |  L]  ,  P.evI.consX) 
rever3e_edge_ list (L, RevL) , 
cons (RevL, [H, X, Y) , RevLconsX) . 
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reverse 


reverse 


reverse 


I , RevLconsXY) ,     ! 


/*  Re 
/*  No 
/*  If 
liiie_ 
line_ 
line_ 
liiie_ 
line 


turn  the    point  of  intersection  of  two  lines,  fail  if  parallel.  */ 
te:  next  4  rules  are  included  to  retain  precision  where  possible. 

lines  share  a  point,  Lliat  point  is  tlie  intersection:  */ 
intersection(Xl,yl,X2,Y2,Xl,yl,X4,y'5,Xl,yi) 
intersection  (XI,  Yl,X2,Y2,X2,Y2,X'J,y4,X2,Y2) 
intersection (X1,Y1,X2,Y2,X3,Y3,X1,Y1,X1,Y1) 
intersection (XI , Yl , X2, Y2, X3, y3, X2 , y2, X2,  Y2) 
intersection  (Xl,yl,X2,y2,X3,y3,X'1,y4,Xi,Yi) 
not (X2  =  -X1)  ,  /' 

/' 


not  (X4— X3)  , 


/ 


line 


Ma  is  (Y2-Y1)  /  (X2-X1)  , 
Ba  is  Yl-Ma*Xl, 
Mb  is  (Y4-y3) / (X4-X3) , 
Db  is  y3-Mb*X3, 
not  (Mb=-=Ma)  , 
Xi  is  (Ba-Bb)  /  (Mb-Ma)  , 
Yi  is  Mb*Xi  4  Bb,   ! . 
inter sect i on (X),Y1, XI, Y2,X3,Y3,X4,Y4,Xi,Yi) 


/* 
/* 
/* 
/* 
/* 


Handle  separately  if  */ 
one  line  is  vertical 
Slope  of  Ist  line  */ 
y-intecept  of  1st  line  */ 
Slope  of  2nd  line  */ 
Y-intecept  of  2nd  line  */ 
Tliis  happens  if  lines  are  parallel  */ 


Case  where  1st  line  is  vertical 
Fails  if  both  lines  vertical  */ 


'/ 


line 


line 
li  ne 
line 
line 


not(X4==X3),  /' 

1^)  is  (Y4-Y3) / (X4-X3) ,  /' 

Bb  is  Y3-Mb*X3, 

Xi  is  XI, 

Yi  is  Mb*Xi  +  Bb,   !  . 
inter3ection(Xl,Yl,X2,Y2,X3,Y3,X?,Y4,Xi,Yi)  :- 

not(X2-^Xl),  /*  Case  where  2nd  line  is  vertical  */ 

Ma  is  (Y2-yl)  /  (X2-X1)  ,  /*  Fails  if  both  lines  vertical  */ 

Ba  is  Yl-Ma*Xl, 

X  i  i  51  X  3  , 

Yi  is  Ma'Xi  ^  Ba,  ' . 
intersection (XI, Yl, X2, Y2, XI, Yl, X2, Y2, XI, Yl) .  /*  If  lines  are  identical  */ 

/*  return  the  1st  vertex  as  intersection  point.*/ 
intersection (XI, Yl, XI, Y2, XI, Y3, XI, Y4, XI, Yl) .     /*  Case  where  lines  are  * 

/*  vertical  S  coincident;   return  1st  vertex  of  1st  line  as  int  pt .   * 
intersection (XI, Yl , XI, Y2, X3, Y3, X3,Y4, Xi, yi)  :-   /*  Case  where  lines  are  * 
!,  fail.  /*  butli  vertical,  but  not  coi  iicitlent  ;  fail.  * 

intersection (XI,  Yl,  X2,  Y2,  X3,  Y3,  X4,  y4,  XI,  Yl)   :-   /*  Coincident  lines  */ 

not (X2==X1) , 


not  (X4=-X3)  , 
Ma  is  (Y2-Y1) / (X2-X1) , 
Ba  is  Yl-Ma*Xl, 
rib  is  (y4-Y3)  /  (X4-X3)  , 
Bb  is  Y3-Mb*X3, 
Ma='=Mli, 
Ba==Bb,   !  . 
/*  If  lines  are  coincident. 


/' 

r 
/' 
/' 
/' 
/' 

ret  urn 


Slope  of  1st  line  */ 

Y-intecept  of  1st  line  */ 

Slope  of  2nd  line  */ 

Y'-intecept  of  2nd  line  */ 
Parallel  */ 

Same  y-intercef>tr  s  */ 
Ist  vertex  of  1st  line  as 


int  pt  */ 


it; 


virtual_vertex  (XI  ,  Y]  ,  X?,  Y2,  X3,  Y3,  X-l,  Yl,  Xv,  Yv)   :-     /*  the  virtual  vertex  is  */ 
line_inter3ection (XI, Yl, X2, Y2,X3, Y3,X4, Y4, Xv, Yv) , ! .   /*  the  point  of  */ 

/*  intersection  of  the  lines.  */ 

distance  (XI, Y1,X2,Y2,D)  :- 

D  is  sqrt  (  (X2-X1) '"2  +  (Y2-Y1)^2). 

/*  Counts  length  of  a  list  */ 

list_length ( 1 ] , 0)  . 

list_length ( [Xl Rest ] , Iplusl)   :- 

listlength (Rest, I) , 

Iplusl  is  I  +  1 . 


/*  If  cost  data  is  present,  find  */ 
/*  weighted  cost  of  path;  */ 


/*  If  cost  data  is  not  present,   */ 
/*  find  Euclidean  length  of  path  */ 


/*  Computes  length  of  edge  P  */ 

edge_length  (  |  ] , 0)  . 

edgelength ([_,_] ,0) . 

edgelength ( ( XI , Yl , V, X2, Y2 | P ) , D)   : 
edge_lenqth ( (X2, Y2 | F ) , Dl ) , 
distance (XI, Y1,X2,Y2,D2) , 
U  is  Dl  +  D2,   !  . 


/*  Computes  tlie  distance  between  pt.  s  1  ^  2  along  patli  P  */ 
/*  First  travels  down  the  path  until  pt  1  is  found  */ 
/*  then  constructs  list  btwn  ptl  S  2,  then  finds  its  length  */ 
patli_distance  (XI,  Yl,  X2,  Y2,  [X1,Y1|P],D)   :- 

path_distance2  (X1,Y1,X2,Y2,  [X1,Y1|P],P12), 

path_length (P12, D) ,   !. 
path_distance (XI, Y1,X2, Y2, (X3,Y3,c(C) |P],D)  :- 

path_distance  (XI, Y1,X2, Y2, P, D)  . 
path_distance2 (XI, Yl, XI, Yl, _,  ())  . 
path_distance2  (X1,Y1,X2,Y2,  |X2,Y2|P),  |X2,Y2))  . 
path_distance2  (XI, Yl, X2, Y2,  |X3,Y3,c(C)  IP],  (X3,Y3,c(C)  llntList))   :- 

path_distance2 (X] , Yl, X2, Y2, F, IntList) ,  ! . 

same (A, A) .    /*  succeeds  if  both  args  are  the  same,  fails  otherwise  */ 

/*  concat  arg  2  (atom),  onto  end  of  arg  1  (list),  return  as  arg  3  (list)  */ 
cons([],B,B)   :-  !. 
cons  (  (X|B1) , B2,  (X|B3) )  :- 
cons (Bl, B2, B3)  ,  !  . 

/*  A  robust  arccosine  routine  (in  C-Proloq,  acos(l)  bombs)  */ 

ar ccos (X, 0)  :  - 

X  >  0.99999,    !  . 

arccos(X,A)  :-  A  is    acos(X),   !. 

/*     Remove    the     last     pair    of    coorrlr"    from    the     Ist    arg,     return    as    7iid    arg     */ 
remove_last_pt ( |X, Y, X2, Y2] , (X, Y) ) . 
remove_last_pt (IX,Y|L),(X,Y|RevL))      :- 
remove    last    pt (L, PevL) ,      ! . 
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convert    de9r_to_ratIs  (Angle    in    Deg,  Angle_in_Rad)     :- 

degr_to_rads_f actor (F) , 

Angle_in_Rad  is  F*Angle_in_Deg,  !. 
convert_rad3_to_degr (T2,T2Ueg)  : - 

rads_to_degr_f actor (F2) , 

T2Deg  is  F2*T2,   ! . 
deqr_to_rad3_f actor (F)  :-  F  is  3.14159/180. 
rads_to_degr_factor (F)   :-  F  is  180/3.14159. 

/*    Succeeds    if    Ist    patli    includes    2nd    patli,     fails    otherwise.     */ 
/*    Assumes    both    arguments    are    bound.     */ 
includes_patli  (P»  P)  :  -     '• 
includespath ( [XI, yi, c (C)  |P1],P2)     :- 
iiicludes_path  (PI,  F2)  ,      !. 

/*  Succeeds  if  arg  1  is  a  member  of  2nd  arg  (a  list) ,  else  fails  */ 
member (X,|X|PJ)  :-  !. 
member (X,  1X2 | R) )  :- 

menxber  (X,  R)  ,  !  . 
/*  Succeeds  if  args  1  and  2  are  members  of  3rd  arg  (a  list)  */ 
/*  in  order  listed,  else  fails  */ 
member  (X,  y,  (X,  Y  I  R)  )  :-  !. 
member (X,y,  1X2, Y2  I  R] )   :- 

member (X, Y, R) ,   ' . 
/*  Succeeds  if  args  1  thru  4  are  members  of  5th  arg  (a  list)  */ 
/*  in  order  listed,  eJse  fails  */ 
memtier  (Xl,yl,X2,Y2,  [X1,Y1,X2,Y2|R])  :-  !  . 
member (XI, Yl , X2, y2, [X3, Y3, X4 , Y4 | R) )  :- 

member (X1,Y1,X2,Y2, [X4,Y4|R)),   I . 

abs (A, A)  :-  A  >=  0. 
abs  (A, -A)   : -  A  <  0. 

/*  NOTE:  For  development  purposes  (until  a  pt-to-pt  patli  planner  is  */ 

/*  included  in  the  program)  optimal  pattis  from  each  terrain  feature  */ 

/*  vertex  must  be  included  in  the  mapdata  file.  Additionally,  OP' s  */ 

/*  from  each  sliortcut t ing  point  along  the  opposite  edge  must  be  incl .  */ 

/*  There  are  two  ways  to  query  an  optimal  path:  */ 

/*  1.  opt imalpath ( [X, y I r] )  will  get  an  OF  from  pt  X, Y  if  such  an  OP  */ 

/*     exists  in  the  database.  */ 

/*  2.  optimalpath  (  (X, Y IP] , C)  witli  C  unbound  will  get  the  OP  from  X,y  */ 

/*     and  determine  the  cost  of  tlie  path.  */ 

/*  3.  optimal_path ( [X, y I P) )  will  get  a  ' pseudo  OP'  from  X, Y  if  one  */ 

/*     exists  and  there  is  no  '  opt  ima  l_path'  ;  this  is  aj.iplicable  to  tlie  */ 

/*     first  pass  only.  */ 

/AAAAAAAAAAAAAAAA*AAAAAAA*AAAAAAAA*AAAAAAAAAA*AAAAA*A*AAA*AAA*AAAA*A****/ 

/*    Computes    the    cost    of    an    optimal    path,     given    tlie    path    in    tlie    [iB  */ 

opt imal_path (L, D)     :- 

var  (D) ,  /*  If  opt  path  with  total  cost  is  already  */ 

opt  imal_patli  (7j)  ,         /*  asserted,  use  it  (bgmapdata  is  consulted  */ 

optimal  path2(L,P),!.    /*  before  bgutils),  else  coinput  e  it  here.  */ 
ortimal_path2 ( (XI , Yl , c (C) , X2, y2) , Dl )   :-      /*  If  optpath  has  cost  data,  use  */ 

distance  (XI,  Yl,  X2,  Y2,  L')  ,  Dl  i  .^  C*D,   !.   /*  this  rule  as  the  base  case.*/ 
optimalpat h2 ( [XI, Yl, c (C)  , X2, y? I  Rest ] , D)  :-   /*  If  opt  path  has  cost  data  use  */ 

opt imal_pat!i2 (  [X2, y2  I  Pest ) , D2)  ,  /*    this    rule    as    the    rec.     case    */ 

distance (XI, y] , X2, Y2, Dl ) ,  Dla  is  C*D1, 

D  is  Dla ID2,  !  . 
opt imal_pat h (L)   :- 

pseudo_opt imalpath (L) . 

/*    succeerln     if    1st    pt     i .''    on    line    .i^gmont    between    pt  2    &    pt-3    iii'^jusive    */ 
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_  I 
-  I 


on_line (X1,Y1,X1,Y1,X2,Y2) 
on_line (X2, Y2, XI ,  Yl ,  X2,  Y2) 
oi)_line  (Xi,Yi,Xl,Yl,X2,Y2) 

between(Xi,Xl,X2) ,  between(Yi,Yl,Y2) , 

DelX  is  X2-X1,  DelY  is  Y2-Y1,  not  (between  (DelX, 0, 0)  )  , 

Yj  is  (Xi-X2) *DelY/DelX  +  Y2, 

witliin_toie  ranee  (Xi  ,  Yi  ,  Xi  ,  Y  j)  ,   !  . 
on_line (Xi, Yi, XI, Y1,X2, Y2)  :- 

between (Xi, XI, X2)  ,  between  (Yi , Yl , Y2) , 

DelX  is  X2-X1,  DelXi2  is  X2-Xi, 

within_tolerance (DelXi2 , Yi, DelX, Yi ) ,  ! . 


edge_visibilit y_check 
CrossProdZ  is 
CrossProdZ  >= 

edge_visibility_clieck 

edge_visibility_check 

(Xa, Ya, V | Revi 

CrossProdZ  is 

CrossProdZ  >= 

edge_visibili 

edge_vi3ibility  check 

[Xa, Ya, hIRevi 

edge_visibili 


( [Xa, Ya,Xb, Yb], [Xg, Yg],   ( Xa, Ya, v, Xb, Yb] )   :- 

(Xb-Xa) * (Yg-Ya) -  (Yb-Ya) *  (Xg-Xa)  , 

0, !.   /*  True  if  AngleGAB  is  between  0  and  pi, 

/*  which  is  true  if  AB  is  visible  from  G. 
( (Xa,  Ya, Xb, Yb) ,  [Xg, Yg] ,   [Xa,  Ya, h, Xb, Yb ) )   :-  !. 
( [Xa,  Ya, Xb, YblRListRest] ,  [Xg, Yg) , 
sedRListRest ) )  :- 

(Xb-Xa)  *  (Yg-Ya) - (Yb-Ya)  *  (Xg-Xa)  , 

0,     /*  True  if  AngleGAB  is  between  0  and  pi,  */ 
/*  which  is  true  if  AB  is  visible  from  G.*/ 
ty_check ( [Xb, Yb| RListRest ) , [Xg, YgJ , RevisedRListRest ) , ! 
( [Xa, Ya, Xb, Yb| RListRest] , [Xg, Yg] , 
sedRListRest  J )  :- 
ty  check ( (Xb, Yb| RListRest) , [Xg, Yg] , RevisedRListRest) , ! 


V 
*/ 


set_done_f lag (Xbdry, Ybdry)   :- 
ma>:X  (MaxX)  ,minX  (MinX)  , 
maxY (MaxY) ,minY (MinY) , 
Xbdry  >  MinX- (MaxX-MinX) /2, 
Xbdry  <  MaxX+ (MaxX-Mi nX) /2, 
Ybdry  >  MinY- (MaxY-MinY) /2 , 
Ybdry  <  MaxY+ (MaxY-MinY) /2 ,   ! 

set_done_f  lag  (Xbdry ,  Yljdty  )   :-        /* 
assert  (done )  ,  !  . 


/*  Compute  bdry  until  it  is  */ 

/*  <3ff  the  page  by  1/2  the 
/*  width  of  the  jiage,  to 
/*  account  for  rotation. 


if  bdry  is  off  tlie  output  |->age, 
/*  set  "done"  */ 


store_2vi3_re suits (Tl , T2, Yl , Y2, B, Dg, Vx, Vy ) 
Xg  is  Vx  +  Dg*cos(B), 
Xbaseline  is  Xg  -  Yl*sin(Tl), 
Xbdry  is  Xbaseline  -  Y2*sin(T2), 
Ybdry  is  Vy  +  Y2*cos(T2), 
set_done_f  lag  (Xlndry,  Ybdry)  , 
retract  (bdry  (Bl.ist)  )  , 
assert (bdry ( [Xbdry, Ybdry | BList ] ) ) , 


/* 
*   Output  predicates. 

*/ 

output _init  bdrys  :- 

tell  (bdry_oul:  )  , 

number  of  edges (N), 

wr ite_to_bdry_f ile (number_of_edges, N) , 

nl, 

init  bdry  (  [tJ]  ,  tl2)  ,  P)  , 

write_to_bdiy_f  ile  (bdiy,  P,  1)1,  112)  , 

fail, 
out  put_init_bciry3  . 


27X 


output_active_bdry3  :- 

tell (bdry_out) , nl, 

activebdry  (  [Nl, N2] , B)  , 

wtite_to_bdry_f ile (bdry, B, Nl, N2) , 

fail. 
output_active_bdrys . 


*   Output  prolog  facts  to  file  "bdry_out" 
*/ 
write_to_bdry_f ile (title, Title)  :- 

writef lag (no_write) ,   ! . 
write_to_bdry_f ile (title, Title)   :- 
write_flag (write) , 
tell (bdry_out) , 
write  (' title  (''') ,  write  (Tit le)  ,  write  (''').')  , 


nl. 


wr ite_to_bdry_f i le  (goaJ ,  (X,Y))   :- 

write_f  lag  (rio_write)  ,  !  . 
write_to_bdry_f ile (goal,  1X,Y))   :- 

wr ite_f lag  (write)  , 

tell (bdry_out) , 

wri  te  ('  goal  ('  )  , 

write  (  (X, Y] )  , 

write  (').'),  nl. 

write_to_bdry  file (number  of  edges, N)  :- 

write_f lag (no_write) ,   ! . 
wr ite_to_bdry_f ile (number_of  edges, N)  :- 

wr it e_f lag  (write)  , 

tell (bdry_out ) , 

write ( ' number_of_edges ( '  )  , 

write  (N)  , 

write  (').'),  nl  . 

write_to_bdry_f ile (opposite_point ,  ( X, Y, Xm, Ym, Xp,  Yp ] )  :- 

wr ite_f lag (no_wr i  te)  ,   !  . 
wr ite_to_bdry_f ile (opposite_point ,  [X, Y, Xm, Ym,  Xp, Yp] )  :- 

wri tef lag  (write)  , 

tell (bdry_out ) , 

write  ('opposite  point  ( '  ) , 

write  (X),  write(','),  write (Y), 

write  (').'),  nl, 

write  ('  opposite_poi  nt_niinus  ( '  )  , 

write (Xm),  write  (','),  write  (Ym), 

writeC  )  .'  )  ,  nl, 

write  (' opposite_point  plusC), 

write  (Xp)  ,  writeC,'),  write  (Yp)  , 

write  (').'),  nl. 

wr  ite_to_l5dry_£  i  le  (  region,  P  )  :- 

wr ite_f lag  (no_wr i te )  ,   !. 
write_to_bdry_f  ile  (region.  P.)   :  - 

writeflag  (write)  , 

tell (bdry_out) , 

wr  it  e  (' region  (')  ,  write(P.),  write(').'),  nl  . 


wr  it  e_to_  bdry  f  i  le  (  region  elisi;,P. )  :- 

wr it e_f lay (no_wi ite) ,   !. 
wr  ite_to_l)dry_f  ile  ( r egion_elist ,  R)   :  - 

write_flag(wrjt.p)  , 

tell  (bdry_out )  , 

write  (' region_eliEt  (' )  ,  write (P) 


write  ('  )  .  ' 


nl  . 


IT) 


write_to_bdry  f i le (bdry , D, N) , N2)   : 

wr iteflag (no_write) ,  !. 
write_to_bdry_f ile (bdry,B,Nl,N2)  : 

wt  i  te_f lag (write) , 

tell (bdryout ) , 

write  ('  bdry  (')  , 

write ( IN1,N2| ) , write  (','), 

write  (B) , 

write  (').'),  nl . 

write_to_bdry_f ile (bdry, B)  :- 

wr ite_f lag (nowrite) ,  !. 
write_to_bdry_f ile (bdry, B)  :- 

write  flag  (write)  , 

tel J  (bdryout ) , 

write  ('  bdry  ('  )  , 

write (B) , 

write  (').'),  nl  . 


*   Output  graphics  instructions  in  "figure"  format  to  file  "bdry_fig" 
*/ 
out put_to_f igure_f ile  :- 

tell (bdryfig) , 

write_heading (bdry) , 

bdry (BdryList) , 

wr it e_to_f ig_f ile (bdry, BdryList) ,   ! . 

wr ite_to_f igf ile (tit le)   :- 

tell (bdry_f ig) , 

title  (Text)  , 

assert z  (subtitJe  ('')), 

subtitle  (Te;:t2)  , 

assertz (widt h_of _tit le (10) ) , 

widtli_of_title  (W)  , 

Indent  is  4.25  -  W/16, 

wri  te  (drawte::t)  ,  nl  , 

write  (Indent)  , write (' 

write (Text) , nl, 

write  (drawtext) , nl, 

write (Indent) , write (' 

wri  te  (Text2)  , nl,   !  . 
write_to_f ig_f ile (t it le )  :-  ! 


/*  Default  width  */ 

'),write(10.3),write('  '),write(0),nl, 
'),write(9.9),write('  '),write(0),nl, 


wr ite_headinq (bdry )      :- 
te] 1 (bdry_f ig) , 

wtite(li  lie  style)  ,n],     wiite(l)  ,nl, 
write(linewidth) ,nl,     write(O.Ol) ,nl. 

write    headiiiq(region)      :- 
~       tell (bdry_f ig) , 

write  (linestyle)  , nl ,     write  (2)  ,  nl, 
write  (linewidtli)  ,  nl,     write  (U.03)  ,  nl. 

wt  ite_t  o_  f  i  g     r  i  1«>  (bdry,   (XI  ,  Yl  ,  X2,  Y2  I  Flesl.  ]  )      :- 

t"ll (bdry  fig) , 

draw_line (XI , Y 1 , X2, Y2) , 

wr  it:<=_to_f  ig_f  ile  (bdry,  [  X2  ,  Y2  1  Rest  ]  )  . 
write_to  f i q  file  (bdry,   ). 
write_to_f i  g_f ile (inv_bdry,  [ X 1 , Yl , X2 , Y2 | Rest ] ) 

tell (bdry_fiq) , 

draw  line  inv  (XI , Yl , X2 , Y2)  , 
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write_to_f igfile (inv_bdry,  [ X2, Y2 | Rest  J )  . 
write  to_f ig_f ile (inv_bdry , _) . 

write_to_fiq_file (goal, (X,Y])  :- 

tell (bdry_f ig) , 

scale_coords (X, y, XI, Yl) , 

write  (line style)  ,  iil,  write  (1)  ,  iil, 

write  (circle)  , nl, 

write (XI) , write  ('  '), write (Yl ), write  ( '  '),  write (0) , nl , 

write  (0.04) , nl,  !  . 
write_to_fig  f ile  (inv  goal,  [X, Y] )  :- 

tell (bdry_fig) , 

scale_coord3_inv (X,Y,Xl,yi) , 

write (line style) , nl,  write  (1  )  , nl, 

write (circle) ,nl, 

write  (XI)  , write  ('  '), write (Yl) , write ('  '), write (0) , nl , 

write  (0.04) ,nl,  !  . 

write_to_fig  f ile (regi on, ( XI, Yl | Rest ) )  :- 

tell (bdry_f ig) , 

write_to_f ig_f ile2  (region,  (XI, Yl |Rest] ,Xend,Yend)  , 

dtaw_line  (XI, Yl , Xend, Yend)  ,   !  . 
write_to_fig_file2 (region, (X,Y],X,Y) . 
write_to_fig_file2 (region, (XI , Yl , X2 , Y2 | Rest ], Xend, Yend)   :- 

tell  (bdryf ig)  , 

draw_line (Xl,yi,X2,Y2), 

write_to_f ig_f ile2 (region, (X2,Y2| Rest), Xend, Yend),  !. 
write_to_f ig_f ile (inv_region, (XI , Yl , X2, Y2 j Rest ] )  :- 

tell (bdry_fig) , 

draw_line_inv (X1,Y1,X2,Y2) , 

write_to_f  ig_f  ile  (  i  nvregion,  (X2,  Y2  |  .(.est )  )  ,   !  . 
write_to_f ig_f ile ( inv_region, _) . 

scale_coords (X, Y, XI, Yl)  :-  /*  Scales  and  translatps  */ 

maxX  (Ma::X)  ,maxY  (Ma.-;Y)  ,minX  (MinX)  ,ininY  (MinY)  ,  /*  coords  to  appropriate  */ 

XI  is  1  +  (6.  5*  (X-MinX)  /  (llaxX-MinX)  )  ,  /*  output  coord  system  */ 
Yl  is  1  4  (9* (Y-MinY) / (MaxY-HinY) ) ,  !. 

scale_coords  i  nv  (X,  Y,  XI ,  y  1  )  :-  /*  also  reflerts  t  lie  */ 

maxX  (t-laxX)  ,maxY  (t-laxY)  .minx  (MinX)  ,minY  (MinY)  ,  /*  coords  about  the  •/ 

XI  is  7.5  -  (6. 5* (X-MinX) / (MaxX-MinX) ) ,  /*  vertical  line  X=4.25  */ 
Yl  is  1  t   (9* (Y-MinY) / (MaxY-MinY) ) ,   !. 

draw_line (X] , Yl, X2, Y2)   :- 

scale_coord3 (XI , Yl , XI b, Y lb) , 

scale_coords (X2,Y2,X2b,Y2b) , 

write  (polyline)  ,  nJ  ,  write  (2)  ,  iil  , 

write (Xlb) , write  ('  '), writ e  (Yl b) , write ( '  ' ) , wr i t e  (0) , n 1 , 

write  (X2b)  , write  ('  '), wri te  (Y2b)  , write ( '  '), write  (0)  , nl ,   !. 
draw_line_inv (XI, Y1,X2,  Y2)   :- 

scale_coords_inv  (XI ,  Yl ,  XI  Ij,  Yll-)  , 

scale_coords_inv (X2, Y2, X2b, Y2b) , 

wr ite(  poly line), n],  write(2),nl, 

write  (Xlb)  , write  ('  '  )  , wr i t e (Y lb)  , wr i te ( '  '  )  , wri t e  (0)  , n J , 

write  (X2b)  , write  (  '  '  )  , wr i te  ( Y2b)  , wr it e  ( '  '  )  , wr ite  ( 0 )  , nl ,   !. 
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AAAAAAAAAA*AAAAAAAAAAAAAAAAAAAAA*A*AAAAAAA*AAAAAA***AAAA*AAAAAAAAAAA* 

A 

*  "bgind22" 

A 

*  File  "bgmapdata"  has  terrain  and  goal  data  used  by  "bdrygeii"  . 

A 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

**AAAAAAAAAA*AA*AAAAAAA**AAA**«*AAAAA*AAAAA*A*AA**A**A*AAAAAAAA*A*AAA/ 

/*   " regionvert ices"  lists  the  vertices  of  one  HCA 

*  in  clockwise  order.   First  point  listed  can  be  any 

*  of  the  vertices. 

*/ 
region_vertices ((4, 20, 30, 70, 40, 71, 60, 30, 36, 8)). 

title  ('  E.xample  22'  )  . 

goalpoint (35, 84)  . 


/A   "_cost "  is  the  time  required  to  travel  one  unit  of  distance 

*  Note  that  this  is  the  inverse  of  the  "cost"  used  in 

*  the  "sis"  code. 
*/ 

inter ior_cost  (2)  . 
exterior  cost  (1 )  . 


*  "opt imal_path"  is  a  temporary  set  of  predicates  which  specify 

*  the  optirnal  path  list  from  each  vertex  in  the  map. 

*  Eventually,  it  will  be  replaced  by  a  rule  which  computes 

*  the  optimal  path  using  a  path-finding  routine  such  as 
"sis"  or  "rrr". 

*/ 

opt  im.3l     path  (M,20,c(l),30,70,c(l),35,84))  . 
optimal_path (|30,70,c(l),35,84))  . 
optiiiial_patli  ([36,8,c(l),60,30,c(l),35,84])  . 
optimal_path (160,30,c(l),35,84J)  . 
optimalpath ((40,71,c(l),35,84])  . 
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